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Abstract 

This  thesis  explores  the  unstable  characteristic  of  an 
integrated  Inertial  navigation  system  (INS)  and  Global 
Positioning  System  (GPS)  receiver.  During  high-dynamic 
maneuvers/  the  ins  Kalman  filter  provides  velocity 
estimates  to  the  GPS  receiver  code  loop  in  an  attempt  to 
remove  doppler-induced  tracking  errors.  The  GPS  receiver 
Kalman  filter.  In  turn,  provides  position  and  velocity 
estimates  to  correct  INS  errors.  Due  to  the  suboptlmal 
nature  of  the  two  individual  filters,  this  closed-loop 
process  neglects  key  elements  of  information:  time  and 
spatial  correlation.  Therefore,  this  closed-loop  system 
guickly  becomes  unstable  during  high-dynamic  maneuvers, 
resulting  in  degraded  navigational  performance. 

Truth  models  of  the  INS  and  OPS  receiver  are 
developed.  Kalman  filters  based  on  these  two  models  are 
combined  to  yield  a  joint-solution  model  Kalman  filter 
which  serves  as  an  indication  of  the  best  structure  of 
integration  possible.  The  eigenvalues  of  the  basic  INS 
error  dynamics  model,  when  subjected  to  various  dynamic 
scenarios,  are  examined.  A  candidate  maneuver  is  selected 
to  compare  the  performance  of  five  systems:  the  INS  truth 
model,  the  GPS  receiver  truth  model,  the  joint-solution 
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model,  a  tvo-fllter  system  containing  the  INS  and  GPS 
receiver  truth  models,  and  a  two-filter  system  containing 
reduced-order  models  of  the  INS  and  GPS  receiver  indicative 


R 


m 


n 

i 


*>> 


of  current  system  configuration. 

The  performance  of  the  individual  Kalman  filters  and 
the  joint-solution  Kalman  filter  are  demonstrated  for  three 
selected  conditions:  stationary  with  respect  to  the  earth, 
a  constant  east  velocity,  and  a  constant  acceleration  turn 
in  the  horizontal  plane.  Results  of  the  two-filter  systems 
are  Incomplete  at  this  time,  and  require  follow-on  efforts. 


PERFORMANCE  OF  GPS-AIDED  INS  DURING 
HIGH-DYNAMIC  MANEUVERS 


I.  Introduction 


1 . 1  Background 

The  integration  of  an  inertial  navigation  system  (INS) 
with  the  Global  Positioning  System  (GPS)  allows  users  to 
realize  capabilities  of  the  main  features  of  each 
Independent  system  along  with  the  additional  advantages 
which  can  only  be  accomplished  by  integrating  the  two 
systems.  However,  under  current  integration  schemes, 
vehicle  dynamics  prematurely  restrict  the  incorporation  of 
GPS  Information  during  all  flight  maneuver  phases  of  a 
mission  (Cox,  1970:144;  Eller;  Tanabe  and  others,  1985; 
Upadhyay  and  others,  1962:120). 

Inertial  navigation  for  aircraft  was  first 
demonstrated  physically  when  a  system  named  Spire, 
developed  by  the  Massachusetts  Institute  of  Technology 
Instrumentation  Laboratory,  was  tested  from  1953  to  1955 
(Draper,  1981:457-458).  The  significance  of  this 
demonstration  was  the  achievement  of  totally  self-contained 
navigation.  This  meant  the  user  could  navigate  without 
using  electromagnetic  signals  which  are  susceptible  to 
jamming  and  detection  by  hostile  agents.  The  INS  has 


evolved  to  the  point  of  being  limited  primarily  by 
Instrumentation  errors  (Upadhyay  and  others,  1962:122). 

The  INS  provides  the  user  with  position,  velocity,  and 
vehicle  attitude  information  during  all  aircraft  maneuvers. 
However,  long-term  drift  errors  arise  due  to 
Instrumentation  errors  which  degrade  navigational  accuracy 
(Srltting,  1971:87-88). 

GPS,  when  fully  deployed  in  the  early  1990's,  will 
consist  of  18  operational  satellites  equally  spaced  in  six 
orbital  planes  (Sturza,  1983:117).  By  processing  range 
and  range-rate  Information  from  four  satellites,  either 
simultaneously  or  sequentially,  a  GPS  receiver  can  solve 
for  the  vehicle's  three-dimensional  position  and  velocity 
vectors,  and  user  clock  bias.  The  attractiveness  of  this 
approach  is  the  very  high  accuracy  which  the  user  can 
achieve.  The  accuracy  of  this  information  is  not  dependent 
on  mission  duration  because  the  signal  processing  does  not 
necessarily  rely  on  past  solutions.  The  receiver  bandwidth 
Is  made  as  low  as  possible  to  reduce  the  susceptibility  of 
signal  jamming  but,  because  of  this  low  bandwidth,  signal 
tracking  Is  jeopardized  during  high  frequency  vehicle 
dynamics  (Upadhyay  and  others,  1982:122-123). 

integration  of  INS  and  GPS  allows  the  navigation 
performance  to  exceed  that  possible  by  either  system 
operating  independently  (Cox,  1978:144).  The  INS  exhibits 
the  ability  to  perform  well  for  short  durations  and  under 
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severe  vehicle  dynamics,  but  is  subject  to  long-term 
drifts.  The  GPS  accuracy  Is  not  limited  by  mission 
duration,  but  the  signals  are  susceptible  to  jamming,  and 
signal  tracking  is  limited  by  vehicle  dynamics.  These 
complementary  features  can  aid  each  other  in  two  major 
aspects : 

a.  The  GPS  long-term  accuracy  can  allow  calibration 
of  INS  drifts  such  that  the  INS  can  operate 
autonomously  for  longer  periods  with  greater  accuracy, 

b.  The  INS  can  provide  vehicle  velocity  data  to  the 
low  bandwidth  GPS  receiver  tracking  loops,  thus 
compensating  for  the  doppler-lnduced  errors. 

This  aiding  results  in  improved  signal  tracking  during 
high-dynamic  vehicle  maneuvers  in  addition  to  providing 
increased  tolerance  to  signal  jamming  (Eller). 

For  these  reasons,  INS/GPS  Integrated  systems  are  very 
attractive  /or  aircraft  navigation.  An  optimally 
integrated  system  would  model  both  the  INS  and  GPS  receiver 
dynamics  and  any  interaction  between  the  two  systems. 
However,  three  historical  reasons  limit  the  use  of  an 
optimal  system  for  on-line  applications: 

a.  The  computer  requirement  greatly  stresses  flight 
computer  capabilities  (Maybeck,  1979:403), 

b.  INS  models  have  been  well-established  without 
relying  on  GPS  availability  (Brltting,  1971;  Widnall 
and  Grundy,  1973), 
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c.  The  GPS  receiver  must  accommodate  a  wide  class  o£ 
users  who  may  or  may  not  have  or  need  an  INS  (Brooks 
and  others,  1982:4.1-1}. 

1 . 2  Problem 

In  the  early  integration  efforts,  separate  INS  and  GPS 
receiver  models  are  maintained,  and  only  selected 
parameters  are  exchanged  between  the  two  systems.  During 
high-dynamic  maneuvers,  the  GPS  receiver  relies  on  the 
Kalman  filter  velocity  estimate  from  the  INS  to  aid  in 
tracking  the  GPS  signals.  At  the  same  time,  the  INS  Kalman 
filter  processes  GPS-derived  vehicle  position  and  velocity 
information  as  measurements  to  estimate  the  navigation 
solution  (Upadhyay  and  others,  1982:120}.  However,  the 
statistical  properties  of  the  INS-estimated  velocity 
information  and  the  GPS-estimated  navigation  solution, 
which  would  be  available  in  a  filter  which  optimally 
combines  all  sytem  information,  are  not  modelled  in  a 
two-filter  system.  By  not  accounting  for  these  statistical 
properties,  a  closed-loop  instability  is  believed  to  exist 
under  certain  vehicle  dynamic  maneuvers. 

1 . 3  Scope 

This  study  examines  and  compares  the  stability  and 
performance  of  the  following  systems: 

a.  A  joint-solution,  fully  integrated  INS/GPS  system, 
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b.  A  full-state  two-filter  system  which  accounts  for 
all  available  spatial  information  passed  between 
filters,  but  neglects  the  time-correlatedness  of  the 
measurement's.  In  other  words,  each  system  does  not 
attempt  to  simulate  or  model  the  other  system. 
Therefore,  the  measurements  are  treated  as  though  they 
are  equally  likely  to  be  in  error  by  a  positive  or 
negative  amount  at  any  instant  of  time. 

c.  A  full-state  two-filter  system  which  does  net 
account  for  the  cross-correlation  between  the  passed 
information, 

d.  A  reduced  order  two-filter  system  which  exchanges 
all  available  information, 

e .  A  reduced  order  two-filter  system  which  typifies 
current  integration  schemes  by  not  accounting  for 
cross-correlation  of  the  passed  information,  and 

f.  Two-filter  systems  which  exchange  limited  amounts 
of  cross-correlation  information. 

From  this  analysis,  a  qualitative  assessment  of  the 
performance  differences  is  made.  The  ultimate  goal  is  to 
achieve  maximum  performance  benefit  with  a  minimum  amount 
of  Information  exchange.  As  such,  only  the  INS  and  GPS 
receiver  are  modelled.  The  satellite  error  dynamics,  type 
and  location  of  the  receiver  antenna,  and  methods  for 
compensating  deterministic  errors  are  of  no  consequence  to 
the  fundamental  closed-loop  system. 


1.4  Assumptions 


In  order  to  study  the  stability  and  performance  of  the 
various  closed-loop  systems,  some  basic  assumptions  of  the 
system  configuration  and  vehicle  maneuver  are  presented. 

1.4.1  INS .  For  the  purposes  of  this  study,  the  INS 
is  chosen  to  be  a  local-level,  north-slaved  system 
mechanized  in  a  north,  east,  down  orientation.  Three  gyros 
and  three  accelerometers  are  mounted  on  a  platform  with 
their  sensitive  axes  perfectly  aligned,  forming  a  mutually 
orthogonal  set.  All  measurements  of  specific  force  and 
angular  velocity  are  referenced  to  the  center  of  the 
platform  which  coincides  with  the  mass  center  of  the 
vehicle.  Although  this  is  not  typical  for  actual  systems, 
transformations  of  the  actual  inputs  to  the  mass  center  of 
the  vehicle  are  possible  which  would  accomplish  identical 
results . 

1.4.2  GPS  Receiver .  The  GPS  receiver  is  a 
four-channel  set  capable  of  processing  signals  from  four 
satellites  simultaneously,  producing  range  and  range-rate 
data  from  the  user  to  each  of  the  satellites.  Only  the 
range  measurements  are  modelled  in  this  study  because, 
under  high  dynamic  conditions,  the  internally-derived 
range-rate  Information  is  unavailable.  It  is  assumed  that 
any  computational  delay  has  been  established  and  the 
navigation  solution  is  available  at  the  required  instant  of 
time.  It  is  also  assumed  that  four  satellite  signals  are 
available  to  the  receiver  throughout  the  vehicle  maneuver. 
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1.4.3  Altimeter .  A  barometric  altimeter  Is  available 
for  measurements  to  the  ins  and  gps  receiver  processing 
units.  This  measurement  stabilizes  the  inherently  unstable 
vertical  channel  of  the  INS. 

1.4.4  Spher leal  Earth .  The  ellipticlty  of  the  earth 
is  ignored.  Reference  ellipsoids  are  available  for  a  more 
accurate  representation,  but  this  factor  is  considered 
Inconsequential  to  the  stability  and  performance 
characteristics  of  the  closed-loop  system. 

1.4.5  Vehicle  Dynamics .  since  Instability  is 
believed  to  exist  during  high  dynamic  maneuvers,  the  system 
Is  considered  to  reside  in  a  high  performance  aircraft. 

The  maneuvers  used  In  this  study  to  excite  the  Instability 
are  subsonic,  high  acceleration  turns  in  both  horizontal 
and  vertical  planes.  The  maneuvers  are  short  In  duration 
such  that  the  favorable  satellite  geometry  chosen  Is 
considered  to  be  fixed  throughout.  For  longer  flight 
scenarios,  the  changing  satellite  geometry  would  be 
properly  modelled. 

These  are  the  basic  assumptions  established  at  the 
outset  of  the  study.  Further  assumptions  concerning  the 
theory  and  analysis  are  presented  as  necessary  In 
applicable  sections  of  the  text. 
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1 . 5  Current  Knowledge 

The  complementary  features,  the  short-term  accuracy  of 
an  INS  and  long-term  accuracy  of  the  GPS  system,  allow 
Integration  in  such  a  way  that  either  the  Kalman  filter  can 
estimate  long-term  INS  drift  given  GPS  measurements,  or  the 
INS  can  provide  velocity  aiding  to  the  code  tracking 
functions  of  the  receiver.  The  latter  benefit  is  analyzed 
In  this  study. 

The  INS-derived  velocity  is  used  to  aid  the  GPS 
receiver  tracking  loops,  thus  reducing  the  bandwidth  of  the 
loops  by  eliminating  the  requirement  to  track  aircraft 
dynamics.  This  reduction  in  bandwidth  allows  the  GPS 
signal  to  be  less  susceptible  to  jamming  Interference 
(Vidnall,  1978:1;  Eller).  This,  in  itself,  is  very 
beneficial  and  causes  no  stability  problem  if  done 
correctly. 

The  gps  receiver  uses  its  measurements  periodically  to 
correct  for  estimated  errors  in  the  INS  position  and 
velocity  variables.  This  is  also  very  beneficial  and,  lr. 
fact,  necessary  for  extended  navigation  performance.  By 
Itself,  no  stability  problem  is  created. 

However,  aircraft  applications  require  both  of  the 
above  processes  to  occur  simultaneously,  creating  a 
closed-loop  system.  A  potential  instability  of  this 
closed-loop  system  exists  because  typical  integration 
schemes  omit  modelling  the  tracking  loop  error,  thus 
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Ignoring  the  coupling  of  INS  velocity  error  Into  the 
receiver  dynamics  (Eller;  Dosh  and  Yakos;  Carrol  and 
Mlckelson,  1977:311).  Therefore,  the  receiver  uses  the 
INS-derived  velocity  as  though  It  Is  from  an  independent 
source,  while  the  receiver  Is  directly  providing 
corrections  to  the  INS  velocity  channel. 

Carrol  and  Hickelson  (Carrol  and  Mickelson,  1977) 
analyzed  the  Instability  of  this  loop  for  the  vertical 
channel.  Their  solution  was  to  develop  a  compensation  loop 
to  improve  the  system  stability,  in  the  design,  they  used 
linearized  system  models  and  steady-state  filter  gains. 

The  approach  was  to  select  a  loop  bandwidth,  determine  a 
compensation  function,  and  optimize  the  system  for  best 
performance . 

Vidnall  (Vidnall,  1978)  also  performed  a  vertical 
channel  analysis  using  a  linearized  error  model.  He 
discusses  three  possible  design  changes:  a  filter-feedback 
limiter,  reduced  INS  error  control  gains,  and  decorrelation 
of  tracking  errors  from  the  GPS  measurement.  He  evaluated 
the  latter  two  in  his  analysis.  The  reduced  control  gains 
of  his  analysis  increase  the  system  cut-off  frequency  by  a 
factor  of  ten  over  his  baseline  system.  The  decorrelation 
approach  results  in  a  completely  stable  system.  However, 
because  of  the  method  for  estimating  detector  gain,  this 
method  is  not  practical  in  high  jamming  or  highly  dynamic 
environments . 
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Eller  (Eller)  concludes  that  adequate  modelling  and 
proper  noise  selection  to  account  for  unmodelled 
nonllnearlties  is  essential  for  Integrating  INS  and  GPS 
systems.  For  his  study,  Eller  models  three  types  of 
process  noise:  dynamics-independent,  nominal 
dynamics-dependent,  and  dynamics-dependent  processes  which 
are  adjusted  by  using  real-time  measurements. 
Dynamics-independent  noises  are  those  which  do  not  change 
as  the  vehicle  undergoes  motion.  These  include  biases,  and 
time-correlated  and  uncorrelated  noises.  Nominal 
dynamics-dependent  noises  arise  during  low  dynamic 
scenarios  in  which  steady-state  conditions  can  be  assumed. 
The  dynamics-dependent  noises  are  associated  with 
acceleration-sensitive  factors  and  instrument 
misalignments.  The  instability  issue  was  not  raised  since 
the  ins  and  GPS  of  Eller's  sytem  provided  measurements  to  a 
single  processor  rather  than  to  each  other. 

Dosh  and  Yakos  (Dosh  and  Yakos)  explored  a  decoupled 
error  integration  scheme.  Their  analysis,  and  subsequent 
test,  showed  the  benefit  of  providing  residual  data  as  a 
raw  measurement  to  a  central  computer  which  interfaces 
between  the  INS  and  GPS  receiver.  However,  the  performance 
of  this  scheme  was  not  demonstrated  in  a  high-dynamic 
environment . 

Tanabe  and  others  (Tanabe  and  others,  1985)  suggest 
including  a  correlator  control  loop  which  directly  uses  INS 
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aiding  Information  to  extract  tracking  errors.  This 
integration  scheme  demonstrates  an  Increase  In  the 
operating  region  of  the  Integrated  system.  However, 
stability  of  the  system  Is  not  guaranteed. 

Each  of  these  articles  evolve  around  the  stability 
Issue  of  the  two-filter  system.  Of  the  studies,  only 
Vldnall's  analysis  of  the  decorrelation  method  exhibited  a 
completely  stable  system.  The  other  approaches  Indicate 
possible  Improvements  for  system  stability,  but  complete 
stability  is  not  demonstrated. 

1 . 6  Approach 

To  analyze  the  system  dynamics  associated  with  an 
IN3/GPS  integrated  system,  INS  and  OPS  receiver  models 
which  represent  the  current  systems  are  chosen.  The  INS 
model  Is  augmenced  with  additional  error  sources  which  are 
significant  when  subjected  to  high  dynamics  and  short  time 
duration  to  more  closely  represent  a  "truth"  model.  The 
GPS  receiver  model  Is  augmented  to  Include  characteristics 
of  a  code-tracking  loop  for  each  of  four  channels  In  order 
to  examine  the  closed-loop  system  dynamics.  The  two  models 
are  combined  with  respect  to  a  common  reference  frame  and  a 
covariance  analysis  Is  performed  for  this  Joint-solution 
filter.  Then  the  models  are  separated  and  analyzed  to 
demonstrate  the  best  possible  performance  of  a  two-filter 
system  if  the  time-correlation  of  measurements  Is 
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neglected.  Next  the  models  are  reduced  to  the  current 
configuration  to  establish  the  baseline  performance. 
Finally,  varying  levels  of  integration  are  studied  and 
compared  to  the  joint-solution  and  baseline  systems. 

1 . 7  Outline 

Chapter  2  introduces  the  coordinate  frames  used  for 
this  study,  the  operation  of  an  INS,  and  concepts  of  the 
GPS  system. 

Chapter  3  presents  the  system  models  used  in  this 
study.  Also,  Kalman  filtering  and  a  performance  analysis 
method  using  covariance  analysis  is  Introduced. 

Chapter  4  examines  the  stability  and  performance  of 
the  joint-solution,  baseline,  and  the  other  levels  o£ 
system  integration  modelled.  The  analysis  results  from 
examining  the  following  areas: 

a.  Eigenvalue  migration  of  the  INS  model  through 

various  turns, 

b.  Performance  of  the  various  filters  under  static 

and  constant  velocity  conditions, 

c.  Performance  of  the  various  filters  during  a 

dynamic  maneuver . 

Finally,  Chapter  5  contains  concluding  comments  and 
recommendations  for  future  study. 


2 . 1  Genera  1 


Navigation  allows  a  user  to  determine  his  position  and 
velocity  expressed  with  respect  to  some  reference.  The 
reference  can  be  at  any  location  convenient  to  the  user. 

The  user's  position  and  velocity  can  be  expressed,  among 
other  ways,  as  components  of  an  orthogonal  or  nonor thogonal 
coordinate  frame.  Therefore,  the  reference  frames  used  in 
this  study  are  first  explained. 

Position  and  velocity  determination  also  Implies  some 
form  of  Instrumentation  which  provides  the  user  with 
information,  either  continuously  or  at  discrete  Instants  of 
time.  Two  types  of  Instrumentation  which  provide  the 
required  Information  are  the  INS  and  the  GPS. 

An  INS  processes  specific  force  and  angular  velocity 
measurements  to  extract  vehicle  motion  from  some  Initial 
location  and  velocity  to  another.  In  space-stabilized  and 
local-level  systems,  gyroscopes,  which  measure  angular 
velocity,  send  appropriate  torqulng  commands  to  a  platform 
In  order  to  maintain  accelerometers,  which  measure  specific 
force,  fixed  with  respect  to  a  chosen  reference  frame.  A 
strapdown  system  operates  similarly,  except  the  instruments 
are  mounted  directly  to  the  vehicle  and  the  "platform"  is 
an  appropriate  transformation  performed  by  the  processing 


unit  (Britting,  1971:186).  In  this  study,  a  north-slaved, 
local-level  navigator  is  used.  Its  description  and 
operating  principles  are  explored  in  this  chapter. 

Unlike  the  INS,  which  relies  on  no  externally 
transmitted  or  received  signals,  the  GPS  receiver  requires 
transmission  and  reception.  A  receiver,  carried  by  the 
user,  receives  and  processes  satellite-transmitted  data  to 
determine  vehicle  location  and  motion.  Receiver  operation 
is  also  explained  in  this  chapter. 

2 . 2  Reference  Frames 

Vehicle  location  and  dynamics  form  the  basis  of  any 
navigation  problem.  As  such,  expressing  position, 
velocity,  and  acceleration  as  vector  quantities  allows  the 
use  of  basic  vector  operations  to  express  relationships 
between  system  variables.  However,  these  vectors  have  no 
particular  meaning  unless  expressed  with  respect  to  some 
chosen  reference  frame.  Three  specific  reference  frames 
are  used  in  the  ensuing  study:  earth-centered-earth-f lxed 
(ECEF)  coordinate  frame,  north-east-down  (NED)  navigation 
coordinate  frame,  and  llne-of-sight  (LOS)  coordinates. 

2.2.1  Earth-Centered-Earth-Flxed  coordinate  Frame . 
The  ECEF  coordinate  frame  contains  a  set  of  three  mutua1ly 
orthogonal  axes  (xfi,  y  ,  zft)  which  originate  at  the  mass 
center  of  the  earth.  The  z^-axis  points  in  a  direction 
which  passes  directly  through  the  north  pole.  The  x  -axis 
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Is  directed  to  pass  through  the  0  Latitude,  0  Longitude 
Intersection  point.  The  0°  Latitude  line  represents  the 
earth's  equator,  and  the  0°  Longitude  line  represents  the 
Greenwich  Meridian.  The  y  -axis  completes  the  orthogonal 
set  in  accordance  with  the  right-hand-rule.  The  ECEF 
coordinate  frame  rotates  about  the  ze-axis  at  the  same  rate 
as  the  earth's  rotation  rate  This  coordinate  frame 

Is  shown  graphically  In  Figure  2.1. 

2.2.2  Worth -East -Down  Wavlgat Ion  Coordinate  Frame 
(Brlttlng,  1971:33-34).  The  NED  navigation  coordinate 
frame  also  is  composed  of  thi.ee  mutually  orthogonal  axes 
(N,  E,  D).  The  origin  of  this  set,  however,  is  located  at 
the  system's  location.  The  D-axis,  for  a  spherical  earth 
assumption.  Is  directed  toward  the  mass  center  of  the 
earth.  The  M-axls  points  toward  the  north  pole  in  the 
plane  perpendicular  to  the  D-axis.  The  E-axis  completes 
the  orthogonal  set  in  accordance  with  the  right-hand-rule. 
This  axes  set  and  its  relationship  with  the  user  and  the 
earth  Is  shown  graphically  In  Figure  2.2. 

2.2.3  Llne-of-Slght  Coordinates .  When  considering 
GPS  satellite  positions  with  respect  to  the  user,  the 
ensemble  LOS  vectors  do  not,  in  general,  form  a  set  of 
orthogonal  axes,  as  was  the  case  with  the  ECEF  and  NED 
navigation  coordinate  frames.  However,  just  as  a 


Figure  2.1.  ECEF  Coordinate  Frame 


Figure  2.2.  NED  Navigation  Coordinate  Frame 


three-dimensional  vector,  v,  can  be  thought  of  as 
components  along  each  of  the  three  axes  of  the  previous 
frames,  it  can  also  be  described  as  components  along  three 
nonor thogonal  axes  (u^,  u2,  )  provided  the  axes  are 

linearly  independent.  Figure  2.3  shows  this  relationship. 
The  relevence  of  these  coordinate  systems  becomes  more 
apparent  as  the  development  of  IMS  2nd  GPS  proceed. 

2.3  North-Slaved,  Loca 1 -Level  Inertial  Navigation  System 
2.3.1  Platform.  The  INS  used  for  this  study  is  a 

glmbaled  north-slaved,  local-level  ( NSLL >  INS.  Three 
single-degree-of-freedom  (SDOF)  gyros  and  three 
accelerometers  are  mounted  on  a  platform  such  that  the  six 
sensitive  axes  (three  for  the  gyros  and  three  for  the 
accelerometers)  form  a  right-handed  orthogonal  set.  Figure 

2.4  shows  one  possible  arrangement  of  the  Instruments  on 
the  platform. 

in  typical  applications,  the  measurements  obtained  by 
the  gyros  and  accelerometers  are  referenced  to  the  center 
of  the  platform,  then  transformed  appropriately  to  the  mass 
center  of  the  vehicle.  The  equations  to  follow  assume 
these  transformations  have  already  taken  place  such  that 
the  resulting  measurements  refer  to  the  mass  center  of  the 
vehicle . 

Another  feature  of  the  nsll  ins  Is  its  orientation. 

The  platform  is  torqued  to  maintain  alignment  of  the 
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Figure  2.3.  Decomposition  of  a  Vector  onto 
Three  honor thogor.al  Axes 


Figure  2.4.  Platform  Containing  Three 
Accelerometers  and  Three  Gyros  (Maybeck,  1979:292) 


sensitive  axes  with  the  NED  navigation  coordinate  frame. 
Thus,  the  sensitive  axes  of  the  NSLL  INS  measure  motion 
with  respect  to  north,  east,  and  down  components.  For  the 
purposes  of  this  study,  the  torqulng  command  applied  to  the 
platform  is  assumed  to  be  perfect.  Also,  the  gyro  and 
accelerometer  sensitive  axes  are  assumed  to  be  perfectly 
mounted  on  the  platform.  Therefore,  the  INS  dynamics  are 
driven  only  by  the  vehicle  dynamics  and  Instrumentation 
errors.  Platform  and  Instrument  misalignments  cause  an 
additional  error  In  the  torqulng  signal,  but  are  considered 
secondary  and  not  considered  In  this  study. 

2.3.2  single -Degree -Of -Freedom  Gyros .  The  purpose  of 
the  three  SDOF  gyros  on  a  NSLL  INS  Is  to  maintain  the 
platform  fixed  with  respect  to  the  NED  navigation 
coordinate  frame.  To  do  this,  the  platform  Is  commanded  to 
account  for  the  earth's  rotation  as  well  as  the  motion  of 
the  vehicle  on  which  It  Is  mounted.  Ideally,  the  resulting 
command  to  the  platform  Indicates  the  angular  velocity  of 
the  NED  navigation  coordinate  frame  with  respect  to 
inertial  space  (Britting,  1971:111).  The  SDOF  gyros 
provide  the  commands  necessary  to  torque  the  platform. 

A  representation  of  a  SDOF  gyro  Is  shown  In  Figure 
2.$.  It  contains  a  mass  which  is  spun  to  attain  a  high 
angular  momentum.  The  mass  is  suspended  within  a  gimbal 
which  is  free  to  rotate  in  one  direction.  The  entire 
assembly  Is  mounted  on  a  platform.  In  Its  nominal  state, 
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the  spin  axis  of  the  mass  is  aliened  with  a  spin  reference 
axis.  Perpendicular  to  the  spin  reference  axis  Is  the 
output,  or  gimbal,  axis.  The  input,  or  sensitive,  axis 
completes  the  orthogonal  set.  An  angular  rate  about  the 
Input  axis  produces  a  torque  on  the  output  axis.  This 
torque  causes  the  gimbal  to  precess  about  the  output  axis 
which  causes  the  spin  axis  to  be  deflected  from  the  spin 
reference  axis  < Lewantowlcz,  1986).  The  precession  rate, 
Wp,  is  related  to  the  applied  torque,  T,  and  angular 
momentum  of  the  mass,  H,  by  the  vector  relationship 


A  signal  proportional  to  the  precession  rate  commands  the 
Dlatform  to  rotate  until  the  torque  Is  nulled,  vhlcn  again 
ligns  the  spin  axis  with  the  spin  reference  axis.  For 
ts  study,  the  process  is  assumed  to  take  place 
Instantaneously  and  perfectly  when  forced  by  vehicle 
dynamics . 

For  a  NSLL  INS,  an  additional  source  commands  the 
platform.  The  vehicle's  angular  velocity  commands  the 
platform  in  the  previous  case.  The  angular  motion  of  the 
NED  navigation  coordinate  frame  with  respect  to  inertial 
space  is  the  additional  source  which  commands  the  platform. 
The  angular  rate  obout  the  north  axis,  v*  ,  is  given  by 
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(2-1) 


where  L  Is  the  latitude  at  which  the  NED  navigation 
coordinate  frame  is  projected  onto  the  surface  of  the 
earth,  and  X  is  the  time  rate  of  change  of  the  celestial 
longitude  which  is  computed  from  the  time  rate  of  change  of 
the  terrestrial  longitude,  i,  and  the  earth's  rotation 
rate,  wifi/  by  the  relationship 

X  =  1  +  w^  (2-2) 

The  angular  rate  about  the  east  axis,  V  ,  is  proportional 

£ 

to  the  time  rate  of  change  of  the  latitude,  that  is 

WE  *  -«*  <2-3) 

Finally,  the  angular  rate  about  the  down  axis,  WD  is  given 
by 

W D  «  -  X  sin  L  (2-4) 

Since  L,  L,  and  1  are  computed  quantities,  the  commands  to 
the  platform  can  be  in  error  depending  on  the  accuracy  of 
the  computations  (Britting,  1971:154). 

2.3.3  Accelerometers .  Accelerometers  are  used  to 
measure  the  contact  specific  force  of  the  vehicle.  By 
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keeping  the  platform  aligned  with  the  NED  navigation 
coordinate  frame,  the  accelerometer  outputs  measure  north, 
east,  and  down  components  of  specific  force.  Vehicle 
acceleration  is  computed  from  the  specific  force  by 
removing  the  gravitational  force  sensed  by  the 
accelerometers . 

An  accelerometer  can  conceptually  be  thought  of  as  a 
proof  mass  suspended  from  a  frame  mounted  on  a  platform. 

If  the  sensitive  axis  (SA)  is  aligned  with  gravity,  the 
accelerometer  measures  lg  of  specific  force.  An 
acceleration  of  the  frame  causes  the  mass  to  b£  displaced 
an  additional  amount  proportional  to,  and  opposite  of  the 
acceleration  direction  (Vrlgley  and  others,  1969:49).  The 
resulting  specific  force  sensed  by  the  accelerometer 
Includes  the  effects  of  gravity  and  vehicle  acceleration. 
Therefore,  the  vehicle  acceleration  Is  computed  by  removing 
gravity  effects  from  the  accelerometer  measurement.  This 
relationship  Is  given  vectorlally  as 

r  -  f  +  G  (2-5) 


where 

V  Is  the  vehicle  acceleration  relative  to  the  Inertial 
frame 

£  Is  the  specific  force  sensed  by  the  accelerometers 
G  Is  the  gravity  vector 
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This  relationship  Is  true  in  all  applications.  However,  1£ 
the  acceleration  Is  expressed  with  respect  to  the  NED 
navigation  coordinate  frame,  an  addir'  >nal  force  caused  by 
the  rotation  of  the  earth  and  the  movement  of  the  NED 
navigation  coordinate  frame  about  the  earth  must  be 
calculated.  This  force  is  commonly  referred  to  as  the 
Coriolis  effect.  This  results  in  the  following 
relationships  between  specific  force  and  vehicle  motion: 
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where 

fu,  f_,  and  f_  are  the  north,  east,  and  down 
components  of  specific  force  as  measured  by  the 
accelerometers 

v_,  and  v_  are  the  time  rates  of  change  of  the 

N  G  D 

north,  east,  and  down  components  of  velocity  (v^,  vg, 

V 

and 

g  is  the  acceleration  due  to  the  gravity  magnitude. 
Errors  in  vehicle  motion  are  Introduced  by  such 
computations  if  the  platform  Is  not  perfectly  aligned  with 
the  NED  navigation  coordinate  frame.  For  example,  if  the 
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platform  were  tilted  such  that  the  north  sensing 
accelerometer  was  not  precisely  aligned  in  the  vertical 
plane  with  the  north  axis,  a  component  of  gravity  is  sensed 
by  the  accelerometer.  When  vehicle  motion  is  calculated 
from  Equation  (2-6),  this  gravity  effect  is  not  removed  and 
apparent  vehicle  acceleration  results. 

2.3.4  System  1 nteract ion .  The  NSLL  INS  is 
functionally  represented  by  the  block  diagram  of  Figure 
2.6.  In  the  figure,  f.  represents  the  specific  force  acting 
on  the  vehicle.  The  resulting  vector  of  measurements  from 
the  accelerometers  is  symbolized  by  £.  This  information, 
along  with  initial  conditions,  is  provided  to  a  navigation 
computer  which  calculates  the  position  and  velocity  of  the 
vehicle.  These  calculations  also  provide  tcrquing  commands 
to  the  platform  to  represent  the  motion  of  the  NED 
navigation  coordinate  frame  with  respect  to  Inertial  space. 
Finally,  the  physical  connection  between  the  platform  and 
the  accelerometer  triad  represents  the  nonlinear 
relationship  of  how  gravity  is  coupled  through  the  platform 
misalignments,  in  other  words,  a  platform  or  instrument 
misalignment  causes  the  accelerometers  to  sense  a  specific 
force  components  due  to  gravity.  The  navigation  computer 
uses  linearized  perturbation  relationships,  to  be  discussed 
in  Chapter  m,  to  obtain  an  accurate  description  of  this 
Information  to  determine  the  vehicle's  position  and 
velocity.  This  same  information  is  used  to  provide 


Imbil  conditions 


Figure  2.6.  NSLL  INS  Block  Diagram 
(Brittlng,  1971:110) 


torqulng  commands  to  the  platform.  The  platform,  In  Its 
new  orientation,  is  again  in  error  and  the  cycle  continues 
(Lewantowlcz,  1986).  The  resulting  motion  of  the  platform 
is  oscillatory  and  unstable  in  nature  (Brltting,  1971:Ch 
7  ) . 

Two  dominant  frequencies  appear  in  the  oscillations: 
Schuler  and  Foucault.  Schuler  frequency,  w  ,  is  given  by 

va  «  <g/R)1/2  (2-9) 

where  g  is  the  acceleration  due  to  gravity,  and  R  is  the 
distance  from  the  center  of  the  earth  to  the  system's 
location.  This  frequency  represents  the  characteristic 
frequency  of  a  hypothetical  pendulum  which  has  a  radius  arm 
equal  to  R.  In  an  accelerometer,  since  the  radius  arm  is 
less  than  R,  any  acceleration  induced  by  changing  speed  or 
direction  causes  the  pendulum  to  deviate  from  vertical. 

This  deviation  exhibits  a  natural  frequency  identical  to 
the  Schuler  frequency  (Wrigley  and  others,  1969:215). 

Foucault  frequency  is  related  to  the  rotational  motion 
of  the  NED  Navigation  Coordinate  Frame  with  respect  to 
inertial  space.  This  frequency,  wp,  is  given  by 

Wp  *  X  sin  L  (Gritting,  1971:128)  (2-10) 

The  magnitudes  of  these  oscillations  depend  upon 


initial  platform  misalignment,  as  well  as  various  forcing 
functions  such  as  instrumentation  errors  and  vehicle  motion 
(Brltting,  1971:ch  7) . 

2 . 4  GPS  Receiver 

2.4.1  Satel 1  lte  S lqnals  .  When  the  GPS  is  fully 
operational  in  the  early  1990's,  18  satellites  will  provide 
highly  accurate  three-dimensional  position  and  velocity 
information  around  the  world.  The  satellites  are  placed  in 
six  orbital  planes  inclined  at  55°.  Each  plane  consists  of 
three  satellites  in  12-hour  orbits  separated  by  120°. 
Between  planes,  the  satellites  are  phased  40°  apart 
(Sturza,  1983:117). 

A  Master  Control  Station  (MCS)  has  uplink  capabilities 
to  each  satellite  for  correcting  the  satellites'  clock 
offset,  frequency,  and  other  parameters  (Mllliken  and 
Zoller,  1978:5).  Four  monitoring  stations  ,  under  direct 
control  of  the  MCS,  collect  data  from  each  satellite.  The 
MCS  uses  this  data  for  its  correcting  operations  (Russell 
and  Schaibly,  1978:75).  In  this  manner,  very  accurate 
knowledge  of  the  satellites'  position  and  motion  exists. 

The  satellites  continuously  transmit  a  50  bit  per 
second  data  stream  which  contains  this  ephemerls  data  along 
with  other  data  including  system  time,  clock  behavior,  and 
satellite  health  (Van  Dierdonck  and  others,  1978:55).  This 
data  is  modulated  by  two  pseudo-random  codes  (PRC):  the 


precision,  or  P-code  and  the  clear/acquisition,  or 
c/A-code.  The  C/A-code  contains  1023  bits  that  repeat  each 
millisecond.  The  P-code  sequence  is  generated  by 
multiplying  two  PRC's  together.  The  first  contains 
15,345,000  binary  data  bits  and  has  a  period  of  1.5 
seconds.  The  second  is  37  bits  longer.  This  code  then  is 
divided  among  the  18  satellites  and  is  regenerated  on  a 
weekly  basis  such  that  no  two  satellites  ever  transmit  the 
same  sequence.  Each  satellite  transmits  the  P-code  on  two 
separate  frequencies  simultaneously:  1575.52  MHz  and 
1227.6  mhz.  This  gives  the  user  capability  to  compensate 
for  ionospheric-induced  path  delays  during  satellite  signal 
transmission  (spllker,  1978:34). 

2.4.2  Receiver  Operation . 

2. 4. 2.1  User  Position  Solution  {Milllken  and 
Zoller,  1978:6-7).  The  four-channel  GPS  receiver  receives 
the  PRC  from  four  separate  satellites  simultaneously.  Bach 
of  these  codes  are  compared  to  identical  Internally 
generated  codes  by  means  of  an  autocorrelation  function. 

By  performing  the  artocorrelat ion,  the  receiver  calculates 
a  time  shift  between  the  satellites'  codes  and  the 
receiver's  codes.  This  time  shift,  scaled  by  the  speed  of 
light,  represents  the  pseudorange  to  each  of  the  four 
satellites.  It  is  called  pseudorange  because  the 
calculated  distance  Includes  timing  uncertainties  between 
the  receiver  clock  and  the  satellite  clocks,  path  delays 
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through  the  troposphere  and  ionosphere,  and  other  lesser 
effects  in  addition  to  the  true  range  between  the 
satellites  and  the  user.  The  user  removes  the 
lonospher ic-caused  path  delays  by  taking  advantage  of  the 
two  transmission  frequencies,  thus  leaving  clock  errors  as 
the  major  error  source  for  calculating  range  between  the 
user  and  the  satellite. 

If  no  clock  errors  existed,  three  satellites  would  be 
sufficient  to  calculate  the  user's  position.  However, 
receiving  signals  from  four  satellites,  the  user  can  also 
calculate  his  clock  offset.  The  receiver  processes  signals 
from  four  satellites  to  obtain  four  equations  in  four 
unknowns.  The  four  equations  solve  the  vectorial 
relationship  between  user  position  in  ECEF  coordinates,  R^, 
satellite  position  in  ECEF  coordinates,  r^,  and  the  vector 
from  the  user  to  the  satellite,  ,  as  shown  in  Figure  2.7: 

s«  -  *1  -  1.1,2,3.«  i 2-11 ) 

But,  only  the  magnitude  of  D ^  («  D,  )  is  known  from  the 
propagation  time  between  tne  satellite  and  the  user. 
Therefore,  a  unit  LOS  vector  is  needed  to  indicate  the 
direction  of  the  satellite  from  the  user.  The  satellites' 
positions  are  known  from  the  epheroerls  data.  The 
approximate  unit  LOS  vector  is  found  either  by  knowing  the 
user's  position  from  an  independent  source  or  by  knowing 
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Figure  2.7.  User  Position  Determination 
(Mllliken  and  Zoller,  1978:13) 
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the  direction  the  satellite  signal  arrives.  Thus, 


*  ^i  “  Di  *  P±  ’  b 


i-1,2,3,4 


(2-12) 


where  p^  is  the  measured  pseudorange  to  the  i  satellite 
and  b  is  the  user  clock  offset.  Equation  (2-11)  then  becomes 


Bu  -  !ij  Si  -  Dt 

*  Si  '  Si  -  />!  *  b 


1  «  1,2, 3, i  (2-13) 


The  four  equations  of  Equation  (2-13)  are  solved 
simultaneously  resulting  in  a  solution  for  user  position 
and  clock  offset. 

2. 4. 2. 2  Signal  Acquisition  and  Tracking .  in 
order  to  determine  signal  propagation  time,  the  receiver 
must  first  acquire  and  then  track  the  signal.  Two  control 
loops  within  the  receiver  accomplish  this  task. 

For  high  accuracy  navigation,  the  GPS  receiver  must 
acquire  and  track  the  P-code  signal.  However,  due  to  the 
length  of  this  code,  direct  acquisition  is  not  reasonable. 
Therefore,  the  receiver  takes  advantage  of  the  slower, 
shorter  length  C/A-code  which  contains  a  handover  word  and 
directs  the  receiver  to  a  specific  message  location  to 
begin  searching  the  P-code.  Once  the  P-code  acquisition  is 
accomplished,  continuous  tracking  is  required  to  achieve 
the  highly  accurate  navigation  solution  (Mllliken  and 
Zoller,  1978:7). 
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The  tracking  function  consists  of  two  interacting 
processes,  once  the  signal  has  been  acquired/  a  relatively 
vide  bandwidth  phase-lock  loop  tracks  the  satellite  signal 
carrier.  By  measuring  the  difference  between  the 
satellite-transmitted  carrier  frequency  and  the  received 
frequency,  the  carrier  loop  determines  a  doppler  shift. 

This  shift  indicates  the  apparent  separation  rate,  or  delta 
pseudorange,  of  the  vehicle  with  respect  to  the  satellites 
(Milliken  and  Zoller,  1976:11-12).  At  the  same  time,  a  low 
bandwidth  delay-lock  loop  slews  the  phase  of  the  receiver's 
internally  generated  code  until  it  achieves  maximum 
correlation  with  the  received  signal.  This  phase  shift, 
scaled  by  the  speed  of  light,  generates  the  pseudorange 
measurement .  The  phase  shift  is  returned  to  the  phase-lock 
loop  as  an  on-time  estimate  to  allow  extraction  of  the  50 
Hz  navigation  data.  In  order  to  allow  more  accurate 
tracking  of  the  code  and,  thus,  the  possibility  of  a  lower 
bandwidth,  the  phase-lock  loop  supplies  its  doppler 
estimate  as  an  aiding  signal  to  the  delay-lock  loop 
(Upadhyay  and  others,  1982:121). 

Since  the  phase-lock  loop  has  a  greater  bandwidth  than 
the  delay-lock  loop,  loss  of  carrier  tracking  implies  loss 
of  code  tracking  and  the  corresponding  failure  to 
demodulate  the  navigation  data.  Flight  tests  at  U.S.  Army 
Yuma  Proving  Ground  determined  that  aircraft  maneuvers  of 
about  4g  causes  a  loss  of  signal  tracking  (Meyer,  1987:8). 


But,  in  typical  applications,  external  velocity  aiding  is 
provided  to  the  delay-lock  loop  In  the  event  that  carrier 
tracking  is  lost.  The  transfer  from  the  doppler  aiding 
internal  to  the  receiver  to  the  external  aiding  source  is 
transparent  to  the  delay-lock  loop,  and  continued 
operations  under  higher  dynamic  maneuvers  is  achieved 
(Cox,  1978:144;  Upadhyay  and  others,  1982:122;  Widnall, 
1978:1) . 

2 . 5  Summary 

This  chapter  presented  the  foundation  for 
understanding  the  basic  INS  and  GPS  receiver  operation. 
The  next  chapter  develops  the  analysis  tools  and  models 
necessary  to  analyze  the  systems  individually,  and  as  an 
Integrated  system. 
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Ill . 


Analysis  Tools  and  INS/GPS  Receiver  Modelling 

Analysis  of  any  system  requires  a  set  of  tools  which 
can  display  the  characteristic  behavior  of  the  system.  In 
this  study,  as  with  typical  INS  and  GPS  systems,  the  Kalman 
filter  as  an  estimator  provides  the  data  processing 
structure  to  solve  the  navigation  equations.  The 
performance  of  these  Kalman  filters  are  judged  by  how  well 
they  represent  the  true  world.  Therefore,  the  basic 
assumptions  of  the  Kalman  filter  are  described  in  this 
chapter  along  with  the  processing  algorithm  which  serves  as 
an  estimator . 

Next,  truth  models  of  the  INS,  gp  •  receiver,  and 
INS/GPS  integrated  systems  are  developed.  These  truth 
models  exhibit  the  characteristics  of  the  optimal  system 
against  wh*  h  the  reduced  order  models  are  compared. 

Finally,  the  basic  structure  of  a  covariance 
performance  analysis  is  presented  along  with  extensions  of 
this  concept  as  applied  to  the  systems  under  study. 

3.1  fcalman  Flit*-  (MaybecK,  1979:4-5) 

A  Koxinan  filter  Is  an  optimal  data  processing 
algorithm.  It  provides  the  best  possible  estimate  of 
system  variables  bv  considering  the  system  dynamics,  any 
available  measurements,  and  initial  uncertainties  of  the 


system  states.  As  with  any  control  system,  the  engineer 
attempts  to  establish  relationships  between  observed 
outputs  and  deterministic  inputs.  To  do  this,  he  develops 
mathematical  models  which  describe  these  relationships.  By 
using  a  Kalman  filter,  however,  the  engineer  goes  a  step 
further.  He  not  only  models  deterministic  relationships 
between  system  variables,  he  also  models  the  uncertainties 
of  his  system,  of  the  inputs  to  the  system,  and  of  the 
measurements  from  which  he  observes  the  system.  This  is 
the  basis  for  the  optimality  of  the  Kalman  filter.  It  uses 
knowledge  of  the  system  and  measurements  device  dynamics, 
along  with  the  modelled  uncertainties,  and  processes  all 
available  measurements,  weighed  by  their  precision,  to 
obtain  a  best  estimate  of  the  variables  of  interest. 

Figure  3.1  illustrates  a  typical  application  of  the  Kalman 
filter . 

3.1.1  Basic  Kalman  Filter  Assumptions .  The  Kalman 
filter  can  only  be  applied  if  three  basic  assumptions  of 
the  system  can  be  made:  the  model  of  the  system  must  be 
described  by  linear  equations,  any  noises  entering  the 
system  or  measurements  are  white,  and  the  amplitudes  of  the 
noises  take  the  shape  of  a  Gaussian  or  bell-shaped  curve. 

It  these  assumptions  are  satisfied,  then  the  mathematics 
Involved  become  tractable,  and  only  the  first  and  second 
order  statistics  (mean  and  variance)  are  necessary  to 
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Figure  3.1.  Typical  Kalman  Filter  Application 

(Maybeck,  1979:5) 
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describe  the  system  completely  (Haybeck,  1979:7-9). 

Linear  system  models  are  difficult,  but  not 
Impossible,  to  find  in  nature.  Therefore,  it  would  appear 
that  Kalman  filter  applications  are  severely  limited. 
However,  when  nonlinear lties  exist,  an  engineer  usually 
linearizes  about  either  a  predetermined  or  a  calculated 
nominal  point  thus  developing  a  linearized  set  of  error  or 
perturbation  equations.  The  second-order  statistics  of  the 
linearized  perturbation  states  are  equal  to  the 
second-order  statistics  of  the  original  system  states. 
However,  since  the  nominal  is  removed  to  generate  the 
linearized  perturbation  equations,  the  mean  of  the  error 
states  becomes  zero  (Haybeck,  1979:299-300). 

The  latter  two  assumptions,  whiteness  and 
Gauss lanness,  concern  the  noise  entering  the  system  and  the 
noise  of  the  measuring  devices.  A  white  noise  is  a  noise 
•which  has  a  constant  amount  of  power  content  across  all 
frequencies.  Furthermore,  a  white  noise  is  not  correlated 
in  time.  That  is,  the  magnitude  of  noise  signal  at  one 
Instant  of  time  does  not  indicate  the  magnitude  of  noise 
signal  present  at  any  other  instant  of  time.  Obviously, 
such  a  noise  does  not  exist  in  nature.  However,  if  the 
power  content  of  a  noise  remains  relatively  constant  over 
the  bandpass  of  the  system,  then  it  can  be  represented  as 
white  as  far  as  the  system  is  concerned.  Often  times, 
system  noises  are  time-correlated  or  do  not  have  constant 
power  content 


within  the  system  bandpass  which  violates  properties  of 
white  noise.  These  limitations  can  be  corrected  by  driving 
a  small  linear  system,  called  a  shaping  filter,  by  a  white 
noise  and  augmenting  this  model  to  the  overall  system  model 
(Maybeck,  1979:7-9,180). 

Two  such  shaping  filters  are  used  in  this  study:  the 
random  constant,  or  bias,  and  the  exponentially 
time-correlated  process.  Figure  3.2  shows  the  random 
constant  shaping  filter  as  an  undriven  integrator  (white 
noise  power  equal  to  zero)  with  some  Gaussian  distributed 
initial  condition.  The  defining  relationship  of  this 
shaping  filter  is  x<t)*0.  The  autocorrelation  indicates 
that  the  value  of  the  bias  is  not  known  precisely,  but, 
whatever  value  it  takes,  remains  constant  for  all  time. 

This  results  in  a  spectral  density  which  contains  only  a 
zero  frequency  component. 

The  exponentially  time-correlated  noise,  as  shown  in 

Figure  3.3,  is  generated  by  passing  a  white  noise  through  a 

first-order  system.  The  describing  equation  of  this  system 

is  x(t)  «  - ( 1/T ) x ( t )  ♦  w(t)  where  T  is  the  time  constant 

of  the  time-correlated  noise,  n(t),  and  w(t)  is  the  white 

2 

driving  noise.  The  power  of  the  white  noise  is  la  /T 
2 

where  a  is  the  mean-squared  value  of  the  time-correlated 
noise.  By  augmenting  these  noise  process  models  to  the 
linear  system  model,  the  system  becomes  one  which  is  driven 
only  by  white  noise  processes. 
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Figure  3.2.  Random  Constant  Process 
(Maybeck,  1979:183) 


Figure  3.3.  Exponentially  Time-Correlated  Process 

(Maybeck,  1979:183) 
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I 

I 

Gaussianness  describes  the  amplitude  of  the  white 
noise.  As  shown  in  Figure  3.4,  a  Gaussian  distribution  is 

I 

bell-shaped  with  the  peak  amplitude  occurlng  suc't  that  the 

actual  value  is  equally  likely  to  lie  on  either  side  of  the 

mean,  z.  The  standard  deviation,  o  ,  indicates  the  mean  ±lo 

z 

band  whe-e  68.3%  of  the  probability  weight  is  contained. 

The  shape  of  the  curve  is  completely  described  by  its  mean 
and  variance. 

If  these  assumptions  (linear  system,  white  and 
Gaussian  noises)  are  satisfied,  then  the  Kalman  filter 
provides  optimal  estimates  of  the  system  variables. 

3.2  Estimator  Equations  (Haybeck,  1979 :Ch  5).  The 
cont inuous -t ime  system  model  is  described  by  first-order 
linear  differential  equations  with  additive  white  driving 
noise : 

x(t)  *  F ( t ) x ( t )  +  w(t)  (3-1) 

where  the  n-by-1  vector  x(t)  represents  the  system  states, 

F(t)  is  an  n-by-n  matrix  which  models  the  linearized 
dynamic  relationships  between  the  states,  and  the  n-by-1 
dimensional  zero-mean  white  Gaussian  noise  vector,  w(t), 
which  is  independent  of  x(t),  has  an  associated  strength  of 

Q(t )  <5  (T)  -  5<W(  t)wT<  t  +  T) )  (3-2) 
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Figure  3.4.  Gauss lan-Shaped  Distribution 
(Maybeck,  1979:10) 
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1 


where  6(r)  is  the  Dirac  delta  function  and  E(*)  Is  the 
expectation  operator. 

For  this  study,  it  Is  more  convenient  to  describe  the 
system  In  the  discrete-time  representation.  Equation  (3-1) 
is  equivalently  written  as  a  difference  equation 

-(ti  +  l)  *  +  (3-3) 

where  0(tt+1,tA)  is  the  n-by-n  state  transition  matrix 
which  relates  the  system  states  in  their  discrete-time 
representation,  and 

BiWd(ti  )5^(  tj ) )  =  Q^ltj}  l«=j  (3-4) 

Eiy^(t,  )w^(t;J)  >  »  0  ixj  (3-5) 

where 

^i+l 

Qd'tl  +  1)  *  /  +  }  Q(ti)  <^,T(ti+i''t  }  d<t 

K 

In  this  study,  the  time-varying  F-matrix  is  approximated  as 
constant  for  the  time  interval  from  t^  to  ti+1>  Therefore, 
the  state  transition  matrix  is  computed  by 

<^(ti  +  l'ti)  *  explF  {ti+i  "  ti)J  (3-6) 

Q<j(t1)  of  Equation  (3-4)  is  approximated  to  first  order  by 
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the  relationship 


W  *  -  tiJ  <3'7) 

This  approximation  is  valid  fox  systems  in  which  the  sample 
time  is  short  compared  to  the  time  constant  of  its  fastest 
dynamic  mode.  In  actuality,  the  noise  strength  matrix,  Q^, 
would  be  adjusted  to  match  empirical  test  data  for  truth 
modelling.  A  reduced  order  Kalman  filter  would  require 
further  tuning  to  match  the  truth  model  characteristics 
properly.  Therefore,  using  Bquatlon  (3-7)  results  in  a 
crude  approximation.  But,  for  comparison  purposes,  it  is 
adequate  for  this  study. 

Discrete  measurements,  used  by  the  Kalman 

filter  can  be  either  linear  or  nonlinear  functions  of  the 
modelled  states  corrupted  by  measurement  noise  vector, 
n(tj).  As  with  the  dynamics  model,  the  nonlinear 
measurement  functions  can  be  linearized  about  a  nominal  and 
considered  constant  for  a  given  time  of  interest.  This 
results  in  a  measurement  imdel 

z(ti)  *  H(t1)x(tl)  +  n( t£  )  (3-8) 

where  H(tj)  is  the  linearized  relationship  between  the 
measurements  and  the  states.  The  time-correlated  portion 
of  the  corruptive  noise,  n,  is  removed  in  the  same  manner 


as  the  driving  noise  described  previously.  That  Is,  a 
linear  shaping  filter  corresponding  to  the  correlated 
properties  of  the  noise  is  augmented  to  the  system  model 
dynamics,  leaving  only  a  white  measurement  uncertainty, 
y(t^),  which  is  independent  of  w(  •  )  and  x ( • ) .  Thus,  the 
augmented  system  model  becomes 


xitj)  *  <p  <t1,t11)x(t1_1)  ♦ 
z(t  )  =  H(t  ) x ( t . )  4  v(t  ) 


(3-9) 

(3-10) 


where  the  dimension  of  H(t^)  and  x(»)  are  increased  due  to 
the  addition  of  the  shaping  filter  states,  and  the 
measurement  noise  strength,  R(tj)  is  given  by 


B(y(t1)vr(t:))> 


Rftj) 


t  ^  t  j 

tj  t 


(3-11) 


Equations  (3-9)  and  (3-10)  describe  the  discrete-time 
system  driven  by  white  system  noise  having  noise-corrupted 
measurements  available  at  discrete  Instants  of  time. 

The  Kalman  estimator  optimally  combines  the  state 
dynamics  model  and  the  measurements  to  produce  state 

A 

estimates,  x(t^),  and  their  associated  covariances,  p(tj) 
in  an  iterative  two-step  process  starting  from  some  initial 


conditions  x(tg)  and  P(tg): 
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a.  Time  propagation 


X(t~)  =  0<t1,t1_1)x(t|)1  (3-12) 

P(t“)  =  0(t1,t1_1)P(t^_1)<^T(tl/t1_1) 

+  Qd(ti_i )  ( 3-13) 

b.  Measurement  update 

K(tA)  =  P(t‘)HT(ti  ){H(t1)P(tj)HT(t1) 

♦  R(t1) j'1  (3-14) 

x(tj)  =  (I  -  K(tl)H(t1)lx(t~) 

♦  K(ti)ziti)  (3-15) 

P(t|)  =  II  -  K(t1)H(t1) )P(t~) 

X  (I  -  K(t1)H(t1)JT 

+  K(tA )R(t1  )KT(ti )  (3-16) 

In  the  Equations  (3-12)  through  (3-16),  the  and 
superscripts  above  the  time  arguments  indicate  the  Instant 
of  time  Immediately  before  and  after  a  measurement  Is 
taken,  respectively,  K(t^)  represents  the  Kalman  gain 
which  optimally  weights  the  system  dynamics  model  and  the 
available  measurement  vector,  zit^).  For  error  state 
analysis,  the  mean  is  always  assumed  zero,  but  Equations 
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<3-12)  and  (3-15)  ace  used  In  modelling  later  in  this 
chapter.  The  Joseph  Form  o£  the  measurement  update  was 
chosen  because  it  is  less  sensitive  to  arithmetic 
truncation  than  other,  nonsymmetr ic,  forms. 

3.3  INS  Error  Mode  1 

This  section  presents  the  INS  error  model  which  is 
linearized  from  the  nonlinear  relationships  of  Chapter  II. 
First,  the  basic  linearized  equations  describing  the 
relationship  between  platform  tilts,  position  errors,  and 
velocity  errors  are  listed.  This  system  is  augmented  to 
include  errors  due  to  the  barometric  altimeter  measurement, 
and  INS  instrumentation  errors. 

3. 3.1  Basic  Equations .  The  basic  ins  error  model 
consists  of  nine  states  and  is  taken  directly  from 
Brlttlng's  model  of  a  NELL  ins  (Brittlng,  1971:122). 
Brltting  used  a  and  k  as  altitude  aiding  for  illustrative 
purposes  to  stabilize  the  vertical  channel  of  the  ins. 
Therefore,  the  simplification  a  *  k  •  0  is  made  because 
the  Kalman  filter  used  in  this  study  optimally  combines  the 
altimeter  measurement  with  the  dynamics  model  rather  than 
performing  the  weighting  nonoptimally  within  the  dynamics 
model  as  described  by  Brittlng.  The  perturbation  equations 
can  be  written  as  nine  linear  differential  equations  in 
which  the  error  state  vector,  in  spherical  coordinates,  is 
defined  as 
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(3-17) 


ICN  (E  fD  dL  41  4h  ^ 


where 

j  are  the  platform  misalignments  about  the  north, 
east,  and  down  axes, 
t  represents  a  perturbation, 
h  Is  altitude,  and 

L  and  l  are  defined  as  latitude  and  longitude, 
respectively. 

The  dynamics  equations  are  (with  the  time  argument  removed) 
x^  «  -  Xsln(L)x2  +  Lx3  -  Asln(L)x4  cos(L)  x0 

(3-18) 

x2  -  AsintDx^  +  Acos(L)x3  -  x?  (3-19) 

*3  -  -  Lx1  -  Acos(L)x2  -  Acos(L)x4  -  sln(L)x0  (3-20) 

x4  *  x?  (3-21) 

x5  =  x8  (3-22) 

x6  «  x^  (3-23) 

x?  ■  -(fD/R)x2  + ( £g/R ) x3  -  i ( i+2wle )cos( 2L)x4 

- ( 1/R ) (L  +  (l/2)i(i+2wle)sln(2L) )x6 

-  (  2h/R  )x?  -Asln(2L)x0  -<2l/R)x9  (3-24) 

x0  *  I fD/Rcos (L) Jx^  -  ( f^/Rcos (L) }x3 

+  titan (L )  +  2(h/R)  Atan(L)  +  2lX)x4 

-  £  (  i/R )  -  (2AL/R)tan(Ji)  )x0  ♦  2Atan(L)x7 

~2( (h/R)-Ltan(L) Jx0  -  ( (2/R) (i+wle> )x9  (3-25) 
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(3-26) 


*9  “  £EX1  ”  fNX2  IRi<1+2wie)5ln(2L) ,x4 

*l2i ;  + 12  +  i(i  +  2wie)C0S2  (L)  )x6  +2rLx? 
+( 2RACOS2 (L) Jxg 


For  convenience,  the  state  vector  Is  transformed  to  a  form 
1 n  which  errors  along  the  navigation  frame  coordinates.  In 
linear  dimensions,  are  readily  available.  That  Is, 


U 


N 


€d  ^pih  ,5pie  <5pid  5vin  ^vie 

(3-27) 


where  PI(,)  end  vi ( . )  are  the  INS  Posltlon  end  velocity 
error  components  along  the  NED  navigation  coordln  ite  axes. 
This  transformation  Is  performed  by  applying  the  following 
first-order  approximations  (Brltting,  1971:97-98): 


<)pin  «  r<5l 

<5vin  “  r<5l 

(3-28) 

<5pjb  *  R  COS(L)  6  1 

<5  v  * 

IE  -  R  COS(L) 6  1 

(3-29) 

^ID  *  '«•> 

avID  -  -i'h 

(3-30) 

*c  "  T*s 

(3-31) 

and 


X 


TF  T_1X 
S  ~ < 


(3-32) 
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where 


T  -  diag (1,1,1 , R, Rcos (L ) ,  -1 , R, Rcos (L ) ,  -1 )  (3-33) 


and  Ffl,  shown  In  Figure  3.5,  is  the  system  dynamics  matrix 
obtained  from  Equations  (3-16)  through  (3-26). 

This  results  in  the  basic  INS  error  dynamics  model 
described  by 


x^t)  -  Fc(t)xc(t)  ♦  n^t) 


(3-34) 


The  Instrument  uncertainties,  n^lt),  are  directly  expressed 
along  the  platform  axes,  thus  further  motivating  the 
necessity  of  the  transformation. 

3.3.2  Complete  INS  Error  Model . 

3. 3. 2.1  Barometric  altimeter.  The  basic  model 
of  Equation  (3-34)  requires,  as  a  minimum,  altitude  aiding 
for  stability  purposes.  A  first-order  Markov  process 
describing  the  baro-altlmeter  error  is  augmented  to  the 
basic  system  equation  such  that 


"(1/rh)x10 


+  v 


alt 


(3-35) 


where  relates  the  correlation  distance  of  weather 
iatterns,  dalt,  with  the  aircraft  speed,  s.  That  is. 
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(3-36) 


-  d 


Alt 


/3 


The  white  driving  noise/  has  a  strength  of 


alt 


2<T.it/Th 


(3-37) 


2 

where  is  the  standard  deviation  of  the  altitude  of  a 
constant  pressure  surface.  The  values  used  in  this  study 
are 


d  .  -  1.6  X  106  feet, 

and  <Tajt  *  500  feet 
(Widnall  and  Grundy,  1973:123-126). 

The  measurement  of  the  error  in  vertical  position  is  formed 
as  (Maybeck,  3979:309) 

zh(ti)  -  <5pID(t1)  -  <5hb(t1)  v(tt)  (3-38) 

The  10-state  INS  error  model  developed  thus  far  Is  the 
minimum  useful  configuration  for  three-dimensional 
applications  and  represents  the  baseline  T ns  error  model. 
This  results  In  the  system  matrix  Ffi  as  shown  In  Figure 
3.6. 

3. 3. 2. 2  Error  sources .  The  INS  error  dynamics. 
Equation  (3-34),  is  driven  additionally  by  gyro  and 
accelerometer  errors.  The  gyro  errors  directly  drive  the 
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3.6  INS  Error  Dynamics  Model  with  Altimeter  Aiding 


platform  tilt  equations  and  are  modelled  as  a  constant  bias 
plus  additional  white  noise.  Refinements,  such  as  slow 
variations  of  the  bias,  scale-factor  and  g-sensltlvlty 
errors,  are  possible  but  due  to  the  slow  coupling  of  these 
errors  through  the  platform  misalignments  and  the  short 
duration  of  the  aircraft  maneuvers  to  bo  analyzed,  are  not 
included  In  the  model.  The  bias  states  (gyro  drifts),  are 
augmented  to  the  system  equations  as 

°N  *  *11  ■  0  ’  *12  ‘  0  °D  *  *1J  '  0  ,3-39' 

where  Du,  d_,  and  d_  represent  the  drift  due  to  the  north, 

n  ft  U 

east,  and  down  gyros,  respectively.  The  equations  for  x^, 
x ^ ,  and  x^  are  modified  to  reflect  these  new  states.  That 
Is, 

•  * 

*1  “  *i(Prevlous  >  +  xn 

x^  ■  x2(prevlous)  *  x12  (3-40) 

X3  -  x^Cprevious)  ♦  x13 

(Widnall  and  Grundy,  1973:86-88) 

The  accelerometer  errors  are  treated  more  accurately 
due  to  the  direct  nature  in  which  they  drive  system  errors 
during  the  short  maneuver  duration.  The  error  model 
contains  white  noise  plus  two  states  for  each 
accelerometer:  bias,  B,  and  scale  factor,  s F.  Both  are 
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modelled  as  random  constants  and  augmented  to  the  system 
equations 


B. 


14 


B 


B 


15 


B. 


16 


SF..  ■  X 


17 


sfb  -  X 

SF^  -  X 


18 


19 


0 

0 

0 

0 

0 

0 


a 

The  <5v  equations  are  modified  to  reflect  the  Inclusion  of 
these  new  states.  That  Is, 


a  « 

x7  »  x7<previous)  ♦  x14  ♦  *hX17 

x8  *  x0(prevlous)  +  x^  ♦  fgX10  (3-41) 

*  x9 (previous)  ♦  x16  +  fDx19 

With  the  addition  of  the  barometric  altimeter  error  state 
and  the  12  states  associated  with  instrument  errors,  the 
complete  INS  error  model  is  now  described  by 


x  j  ( t )  ■  Fj  ( t )  Xjlt)  ♦  Wj(t)  (3-42) 

where  Xj(t)  is  a  19-state  vector.  Equation  (3-42) 
represents  the  complete  ins  error  model  and  is  shown  in 
Figure  3.7. 
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3.4  OPS  Receiver  Error  Model 

The  basic  structure  of  the  GPS  receiver  error  model 
contains  12  states  defined  as 

■  ,4PCN  lPGB  iPGD  iVGK  iVCE  iVGD 

^AGH  ^AGE  ^AGD  **hb  b  (3-43) 

where 


<$fg^  j  Is  the  GPS-derlved  position  error  vector 
component 

dv^  is  the  GPS-derlved  velocity  error  vector 
component 

uA_,  .  is  the  GPS-derlved  acceleration  error  vector 

Gt  •  / 

component 

dh^  is  the  barometric  altimeter  error 
b  Is  the  range  error  due  to  user  clock  bias 

d  is  the  range-rate  error  due  to  user  clock  drift 
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Equations  (3-44)  represent  the  baseline  12-state  GPS 
receiver  error  model  dynamics.  The  dynamics  matrix,  FBG, 
is  shown  in  Figure  3.6. 

3.4.1  Measurement  Model .  Five  measurements  are 
available  to  the  GPS  receiver:  pseudorange  measurements  to 
four  satellites,  as  discussed  in  Chapter  2,  and  a 
barometric  altimeter  measurement.  The  error  in  the 
vertical  position  measurement  is  identical  to  the 
development  for  the  INS  error  model.  The  error  vector  in 
the  pseudorange  measurement,  6  PR,  is  composed  of  several 
error  sources: 

,PR  *  UL06a&  *  *>1  *  a£*  *  «Ec  ♦  Vp* 
where  ur_c  is  a  matrix  of  four  unit  line-of-slght  row 

Lvb 

vectors,  (one  to  each  satellite)  expressed  with 

“LUb 

respect  to  the  NED  navigation  coordinate  frame,  I  is  the 
appropriately  dimensioned  identity  matrix,  6  r*  is  the  error 
vector  due  to  uncompensated  atmospheric  path  delays,  and 
61^,  is  the  vector  of  errors  committed  by  the  code-tracking 
loop  (Levantowlcz, 1986 ) .  For  the  purposes  of  this  study, 
each  <5ry  is  modelled  as  a  constant  bias  and  a  second-order 
code-tracking  loop  is  considered  because  It  performs  better 
than  the  low-pass  filtering  of  a  first-order  model.  These 
models  are  augmented  to  the  basic  system  dynamics  model 


such  that 


3.8  12-State  GPS  Receiver  Error  Dynamics  Model 


V 


>T 


'  ,f 


lilx  *  S(l*12)  ’  (3-«) 

with  the  four  second-order  code-tracking  loops  contributing 
an  additional  eight  states. 

3.4.2  Code-tracking  loop.  A  second-order 
code-tracking  loop  error  model  is  shown  in  Figure  3.9.  The 
equations  describing  this  loop  are  (Vidnall,  1978:13) 

Sic  •  vr  .  »r(irx  *  b  -  '  6vai6  *  wn  ,3-<7' 

'’r  *  arav(irx  4  b  -  irc>  *  avwn  ,3-48) 

where 

vr  is  an  Internally  generated  variable 
ar  and  ay  are  constant,  predetermined  gains 
^vald  ls  the  error  ln  *hc  externally-supplied  aiding 
velocity,  and 

w  is  the  white-driving  noise, 
n 

For  this  study,  a  single-sided  bandwidth,  B.  ,  of  1  Hz  and  a 

L 

damping  ratio  of  0.7071  is  modelled.  Using  the 
relationship  (widnall,  1978:12) 

Bl  »  <ar  +  ay)/4  (3-49) 

results  in  ar  «  2.666  sec-1  and  ay  *  1.333  sec-1.  The 
poles  of  this  system  lie  at  -1.333  ±  jl.333  in  the  complex 
s-plane.  In  actuality,  the  bandwidth  of  the  loop  varies 
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Figure  3.9.  GPS  Receiver  Code  Tracking  Loop 


with  vehicle  dynamics  and  slgnal-to-nolse  ratio  of  the 
received  PRC. 

These  two  additional  states  for  each  channel  are 
augmented  to  the  basic  GPS  receiver  error  dynamics  model  to 
arrive  at  the  complete  dynamic  description 

X<3  “  FG*<3  +  *G  (3'50) 

as  shown  in  Figure  3.10. 

3 • 5  Truth  Model 

The  truth  model  is  derived  by  combining  common  states 
in  the  total  INS  model  and  the  total  GPS  receiver  model, 
and  augmenting  the  two  systems  together.  Thus,  only  one 
position  error  vector  and  one  velocity  error  vector  is 
included  in  the  truth  model  resulting  in  a  36-state  error 
model  described  by 

xj  *  l€rd  pt  <5vT<5h.  dt bt  sft  <5a7  dzl  <5*1  (3-51) 

The  dynamics  matrix,  F^,  relating  these  states  is  formed  as 


(3-52) 
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where  Fj  Is  Identically  the  INS  error  dynamics  matrix,  Fpo 
is  the  portion  of  FQ  relating  the  last  17  states  of  the 
truth  model  (excludes  the  duplicated  position,  velocity, 
and  altimeter  error  states),  FUR  adds  the  terms  <5v  -  <5a 
due  to  the  acceleration  error  modelled  within  the  GPS 
receiver,  and  FLL  adds  the  terms  due  to  the  error  in  the 
velocity  aiding  signal  to  the  code-tracking  loop.  That  is. 


6  v  ,  , 
-aid 


-ULOS4* 


(3-531 


where  the  four  vectors  of  ULOg  and  dv  are  all  expressed 
with  respect  to  the  NED  navigation  coordinate  frame.  The 
truth  model  is  shown  in  Figure  3.11.  Note  that  the  truth 
model  dynamics  matrix  contains  the  velocity  aiding  error 
signals.  As  will  be  seen  in  the  next  section,  this  term  is 
not  available  directly  to  the  completely  modelled,  but 
separate,  GPS  receiver  Kalman  filters,  thus  requiring  It  to 
be  treated  as  an  additional  driving  noise.  Further  note 
that  when  the  basic  GPS  receiver  Kalman  filter  is  used,  all 
code-loop  tracking  information  is  lost.  This  is  because 
the  code-loop  is  not  modelled  within  the  baseline  GPS 
receiver  error  model. 


3.6  System  Integration 

Examination  of  Figure  3.11  reveals  the  error  in  the 
velocity  aiding  provided  to  the  GPS  receiver  code  tracking 
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loop  error  equations  is  modelled  directly  within  the 
dynamics  equations  (FLL  from  equation  3-48).  When  the  INS 
Kalman  filter  and  GPS  receiver  Kalman  filter  are  separated, 
this  direct  relationship  Is  no  longer  available. 

Neglecting  time  correlation,  the  best  information  the 
GPS  receiver  Kalman  filter  has  available  to  simulate  the 
INS  velocity  aiding  error  is  If  the  <5val(j  of  equation 
(3-47)  is  treated  as  additional  white  driving  noise  on  the 
code-tracking  loop.  This  is  necessary  because  the  GPS 
receiver  error  model  does  not  simulate  the  dynamics  of  the 
INS  mechanization.  Therefore,  it  cannot  estimate  the 
time-correlated  nature  of  the  INS  information.  These  two 
interacting  models  are  referred  to  as  the  two-filter 
full-state  system. 

when  the  baseline  Kalman  filters,  representative  of 
the  currently  Integrated  system,  of  Figures  3.6  and  3.8 
Interact,  the  code  loop  error  equations  are  not  modelled 
within  the  GPS  receiver  error  dynamics.  Thus,  no 
Indication  of  INS  aiding  to  the  loop  is  possible.  This 
represents  a  loss  of  all  time  and  spatial  correlation 


between  the  two  filters  in  closed-loop  operation. 

The  above  situations  are  examined  by  means  of 
performance  analyses  for  the  following  systems:  the 


36-state  (joint-solution)  Kalman  filter  based  upon  the 
truth  model;  the  two-filter  full-state  system,  which  models 
the  interacting  19-state  INS  Kalman  filter  arid  24-state  GPS 
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receiver  Kalman  filter;  and  the  baseline  system,  which 
includes  the  basic  10-state  INS  Kalman  filter  and  12-state 
GPS  receiver  Kalman  filter.  For  the  latter  two  suboptimal 
systems,  the  INS  error  Kalman  filter  receives  position  and 
velocity  error  estimates  from  the  GPS  receiver  Kalman 
filter  as  measurements. 

3 . 7  Performance  Analysis 

This  section  develops  the  thought  process  and 
algorithm  considerations  in  order  to  analyze  the 
performance  of  the  three  systems  listed  previously:  the 
optimal  Kalman  filter,  the  two-filter  full-state  system, 
and  the  baseline  system.  First,  a  basic  description  of  a 
general  performance  analysis  is  presented.  Then,  the 
specific  application  to  each  of  the  three  systems  is 
developed . 

3.7.1  General  Description  (Maybeck,  1979:325-337). 

In  general,  a  performance  analysis  is  conducted  as  shown  in 
Figure  3.12.  First,  a  truth  model  is  developed  depicting 
all  that  is  known  about  the  real  world.  For  this  study, 
the  truth  model  is  as  given  in  Figure  3.11.  Candidate 
Kalman  filters,  based  upon  the  truth  model,  are  then 
hypothesized.  Finally,  within  the  framework  of  the 
performance  anaysls,  the  Kalman  filter  performance  is 
compared  against  the  truth  model  to  test  for  adequate 
operation  for  a  specific  application. 
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Figure  9.12.  Performance  Evaluation  of 
Kalman  Filter  Designs  (Haybeck,  1979:327) 


To  Illustrate  the  method  of  this  evaluation,  consider 
Figure  3.12.  The  truth  model  Is  a  mathematical  description 
of  all  available  modelled  states.  Dynamic  driving  noise 
enters  the  truth  model,  usually  as  a  result  of  shaping 
filter  augmentation.  In  addition,  models  of  the 
measurements  and  white  instrument  noise  are  described 
within  the  truth  model  structure.  From  the  truth  model, 
true  state  values,  x^,  and  measurement  realizations,  z^, 
are  available  as  outputs.  The  Kalman  filter  receives  the 
truth  model  measurements  and,  by  means  of  the  previously 
described  estimator  equations,  produces  its  best  estimate 
of  the  states,  x,  which  it  models.  The  true  states  of 
interest,  y^,  are  then  compared  to  the  Kalman  filter 

A 

estimates  of  those  states,  y,  to  arrive  at  the  true  error 
committed  by  the  Kalman  filter.  Finally,  the  feedback 
gains  allow  the  truth  model  to  account  for  any  commanded 
controls  being  applied  to  the  system,  in  many  cases,  as 
with  this  study,  the  applied  control  is  modelled  as  an 
impulsive  reset  to  the  states  which  are  controlled. 

Consider  a  truth  model  described  by 

xt<t)  -  Ft(t>  xt<t)  ♦  wt(t)  (3-53) 

z^Jtj)  «  Ht(ti)  x  t  ( t  A  )  ♦  vt(tt)  (3-54) 

and  a  Kalman  filter,  based  upon  a  design  model  described  by 
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where  all  the  previous  variable  descriptions  apply. 


Since  the  block  of  Figure  3.12  is  a  system  driven  only 
by  white  noise,  the  models  from  Equations  (3-53)  and  (3-55) 
can  be  augmented  together  resulting  in  a  system  described 
by 

X  <t)  •  F  (t)  x  (t)  ♦  v  (t)  (3-57) 

O  O  O  a 

or,  in  its  equivalent  discrete-time  representation 


w 


Sda(tl» 


( 3-56 ) 


where  x^(»)  Is  the  augmented  state  vector  with  partitions 
such  that 


x 

-a 


(3-59) 


F  (t)  Is  the  augmented  system  dynamics  matrix  with 


partitions  such  that 


0 


Fa  * 


(3-60) 


F_J 


and 


w 

-a 


(3-61) 


with  associated  noise  strength 

( 3-S2 ) 

The  Measurement  update  relations  are  developed  by 
considering  the  truth  model  states  and  the  Kalman  filter 
states  separately.  The  truth  model  states  do  not  change  as 
a  result  of  the  Kalman  filter  taking  a  measurement.  That 
Is,  the  truth  model  states  obey  the  dynamic  d»  ctlcn  of 
the  real  world,  so. 


:<V 


(3-63) 


But,  the  Kalman  filter  is  updated  as  a  result  of  the 
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measurement.  Similar  to  Equation  (3-15) 

kit*)  -  Cl  -  K(tl)H(ti)  lx(t")  ♦  K(t1)2t(t1)  (3-64) 

where  the  meaurement/  y^(t ^ ) .  is  derived  from  the  truth 
model.  Substituting  Equation  (3-54)  into  Bquation( 3-64 ) 
yields 


x(t*)  «  (I  -  K(tl>H(t1)  lx(t')  ♦  K(tA )Ht(t1>xt(t1) 

+  K(ti)yt(tJ)  (3-65) 

Prom  Equations  (3-63)  and  (3-65),  an  augmented  description 
of  this  update  is  written  such  that 


where 


w 


VW‘;> 

*  VVW 

(3-66) 

1 

0  1 

1 

1 

(3-67) 

i 

K(tA )Ht(t1  ) 

I  -  K(tj )H(tt> j 

and 


w  * 


0 

K( 1 1  ) 


(3-60) 
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K ( t j )  In  the  above  equations  results  from  the  Kalman  filter 
calculated  gain  as  given  by  Bquatlon  (3-14).  The 
second-order  statistics  of  this  augmented  system  are 
calculated,  using  the  discrete-time  representation,  as 


w 


*a<Vtl-l>p«(tl,<<tl 


'tl-l) 


WVi* 


(3-69) 


Pa(tl> 


VWV^V  +  Ka(ti  )Rt(  *1  >^<*1  > 


(3-70) 


Impulsive  controls  applied  to  the  system  are  treated 
as  follows 


-a(tlC)  “  Da<tl'-a(tl) 

Pa(t!C)  - 


where 


(3-71) 

(3-72) 


VV 


I 


LO 


I 

» 

t 

I 


-w 


I 

!  I  ~  D(tj) 


(3-73) 


Dt<tl)  Informs  the  truth  model  about  Impulsive  resets 
applied  to  the  system  at  discrete  times,  and  D(t^) 
similarly  Informs  the  Kalman  filter  of  such  resets.  The 
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"♦c"  superscript  indicates  the  time  Immediately  following 
the  measurement  update  ("  +  ")  and  the  reset  command  Cc"). 

The  states  of  interest  are  obtained  from  the  truth 
model  and  Kalman  filter  through  the  and  C  matrices  of 
Figure  3.12,  respectively.  The  variance  of  these  states  of 
Interest  are  calculated  as 

P  (t)  «  C  P  <t)CT  (3-74) 

e  a  a  a 

where 

Ca  “  I_Ct  '  C1  (3-75) 

The  presented  algorithm  forms  the  basis  of  the 
performance  analysis  comparing  the  optimal  Kalman  filter, 
the  two-filter  full-state  system,  and  the  baseline  system. 

3-7.2  Joint-solution  Kalman  Filter .  The  development 
of  the  performance  analysis  for  the  joint-solution  Kalman 
filter  directly  follows  the  development  of  the  previous 
section,  in  this  case,  the  truth  model  and  the 
joint-solution  Kalman  filter  possess  the  same  state 
dynamics.  For  gain  calculations,  the  joint-solution  Kalman 
filter  starts  at  the  same  Initial  conditions  as  the  truth 
model.  In  addition,  the  modelled  dynamics  noise  within  the 
Kalman  filter  structure  are  identical  to  those  driving  the 
truth  model.  The  performance  of  the  joint-solution  Kalman 
filter  represents  the  best  possible  estimator  solution. 
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3.7.3  Two-Fl Iter  Systems .  Analysis  of  the  two-filter 
full-state  system  and  baseline  system  requires  an  extension 
to  the  performance  algorithm  since  three  models  are 
represented  simultaneously:  the  truth  model,  the  GPS 

receiver  Kalman  filter,  and  the  INS  Kalman  filter.  In 
addition,  the  INS  now  has  position  and  velocity  estimates 
available  as  measurements  from  the  GPS  receiver  Kalman 
filter.  Finally,  the  INS  Kalman  filter  provides  velocity 
estimates  to  the  GPS  receiver  to  command  the  code-tracking 
loop  in  an  attempt  to  remove  doppler-lnduced  tracking 
errors.  This  velocity  aiding  signal  drives  the  GPS  code 
loop  and  the  ins  estimation  errors  of  the  velocity  become 
the  driving  noise  to  the  GPS  code  loop  dynamics.  The 
full-state  system  is  first  developed.  Then,  the 
modification  necessary  when  considering  the  baseline  system 
is  explained. 

3. 7. 3.1  Full-state  System,  in  the  development 
of  the  performance  analysis  for  the  two-filter  full-state 
system,  recognize  that  the  INS  Kalman  filter  solution  is 
available  at  a  much  higher  rate  than  the  GPS  receiver 
Kalman  filter  solution.  In  typical  applications,  the  INS 
Kalman  filter  produces  a  propagated  state  estimate  at  a  40 
Hz  rate,  while  the  GPS  receiver  and  INS  Kalman  filters 
perform  measurement  updates  at  a  1  Hz  rate  (Lewantowicz, 
1987).  Therefore,  it  is  assumed  the  GPS  receiver  Kalman 
filter  has  processed  its  updated  solution  prior  to 
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correcting  for  INS  position  and  velocity  errors  so  that  the 
INS  receives  full  benefit  of  the  GPS  aiding.  For  analysis 
purposes/  this  processing  is  assumed  to  occur 
instantaneously/  whereas,  typically,  proper  time  tags  of 
the  Information  are  necessary. 

Consider  an  augmented  system  composed  of  the  truth 
model  states,  the  GPS  receiver  Kalman  filter  states  and  the 
INS  Kalman  filter  states  partitioned  as 


The  propagation  relation  of  the  augmented  system  is 

(3-77) 
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0 

Wh-i1 

<  3-7$  > 


VV  ’  *  *d,(V 
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(tA) 


*dt(V 


0 

0 


(3-79) 


At  time  tj,  the  GPS  receiver  Kalman  filter  processes  its 
pseudorange  and  altimeter  measurements,  resulting  In  an 
updated  state  estimate.  Thus, 

xt<t*)  -  x^tt”) 

S<3(tt>  *  H  -  VVVV  4-  KGHtXt  (t;>  ♦  KqW 

(3-80) 


Xjltj)  ■  Xj(t~) 

where  the  t,  G,  and  1  subscripts  refer  to  the  truth  model, 
the  GPS  receiver  Kalman  filter,  and  the  INS  Kalman  filter, 
respectively.  Rewriting  Equations  (3-80)  in  matrix  form 
yields 


*a(tl> 


Aal(tl )-a(tl * 


Kal(ti,^t(tl) 


(3-81) 


where 


Aal(ti) 


KGHt 


0 


1  -  kghg 


(3-82) 
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and 


Kal(V 


0 


( 3-83) 


After  the  GPS  receiver  Kalman  filter  solution  Is 
available/  the  INS  Kalman  filter  is  updated  using  the 
altimeter  measurement  and  the  GPS  Kalman  filter  position 
and  velocity  error  estimates.  But,  the  additional  position 
and  velocity  error  measurements  are  not  available  from  the 
truth  model,  only  the  altimeter  measurement.  However, 
referring  to  Figure  3.13,  the  error  committed  by  the  GPS 
receiver  Kalman  filter,  e_,  is  the  true  error  and 

"V 

represents  the  true  measurement.  Therefore,  these  values 
are  input  to  the  INS  Kalman  filter  as  the  true  measurements 
which  are  processed.  Defining  this  update  time  as  t|*, 
yields 

-t(tl+)  *  ?t(tll 

x^t**)  *  x^t*)  (3-84) 

X.(t|+)  -  II  -  KTHTJxT(t!>  +  K.Z. T 
_  I  1  I  I  — I  1  I  — 1 1 

The  vector  of  measurements,  contains  partitons  of  the 

altimeter  measurement  and  e^.  The  altimeter  measurement 

VJ 

must  come  from  the  truth  model  such  that 
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Figure  3.13.  Performance  Evaluation 


zh  ■  H=tzt  ■  •WtW  *  V 


and,  as  seen  from  Figure  3.13, 


E  £g  ~  *t  *  CG*G(ti)  ‘  ct^tUi) 


Using  these  expressions,  the  INS  update  of  Equation  (3-84) 
is  rewritten 


ijlt;4)  .  (I  -  KjHjl  ♦  KjH^ 


Vt(t1)  ♦  vt 
CG^G<tl)  ”  Ct**t**l* 


This  is  equivalently  written  as 


-  HIaCtIXt<tJ )  4-  K1HIGC0^(tJ) 

+  (I  -  K_HTJxT(t!>  +  K.H..H  .v. 

1  I  —I  1  I  It  s  t  t 


where 

and  cQ  extract  the  position  and  velocity  error 
vectors  from  the  truth  model  and  GPS  receiver  Kalman 
filter,  respectively 

H  .  extracts  the  altimeter  measurement  from  the  set  of 

3  U 

measurements  output  by  the  truth  model,  and 

and  H]g  applies  the  appropriate  subset  of  the  INS 
Kalman  filter  gain  matrix,  KJf  to  the  measurements. 
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From  the  relations  In  Equations  (3-80)  and  (3-84),  the 
complete  update  cycle  Is  deflied 


sa(ti  }  *  Aa2Aal-a(tl)  +  (Aa2Kal  * 

where  Aa2  end  K^,  taken  from  Equations 
as 


Ka2)^t(tl)  <3-85) 
(3-84),  are  defined 


and 


'a  2 
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KI«HItHstHt 
.  -  HIGCt  * 
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kihigcg 


0 
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1  -  KIHI 


(3-06) 


a2 


0 

0 


KIHItHst 


(3-87) 


If  A_  Is  defined  as  A  -A  .  and  K  Is  defined  as  (Am0K,.  + 

4  w  /  "  1  Cl  da  dl 

Ka 2 ) /  then  the  covariance  matrix  update  is  calculated  using 
Equation  (3-70). 

Still  to  be  considered  is  the  velocity  aiding  to  the 
GPS  receiver  code-tracking  loop.  As  an  approx iu_t Ion  to 
the  40  Hz  rate  of  the  INS  Kalman  filter  propagated 
estimate,  the  time  interval  between  t^  and  tJ+1  is  divided 
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into  k  subintervals,  4t^,  where  A -  (t^  -  t^)/k  .  The 

control  Is  applied  impulsively  each  4t^  using  the 
propagated  INS  Kalman  filter  velocity  error  estimate 
available  at  that  time.  From  this  relationship,  the  reset 
commands  are 


Xt<t-C> 

* 

•  vv 

-  Mi 

*G(tkC) 

■  VC* 

■  y**’ 

-  DXj( 

^I(tkC) 

-  vC’ 

*  vv 

( 3-88  ) 


where 


VV  ■  WVi’V'H-i  >  *  wv 


(  3-69  ) 


and  Dt  and  D  transform  the  velocity  errors  expressed  in  the 
NED  navigation  coordinate  frame  to  velocity  errors  along 
each  llne-of-sight  vector  in  order  to  simulate  the  control 
applied  to  the  code-tracking  loop  within  the  truth  model 
and  the  GPS  receiver  Kalman  filter,  respectively.  At  time 
tj^,  after  k  reset  commands,  the  gps  receiver  Kalman 
filter  processes  its  measurements  before  the  INS  errors  are 
corrected . 

The  GPS  receiver  Kalman  filter  should  be  told  that  the 
velocity  aiding  signal  is  not  perfect,  within  the  truth 
model,  the  relationship  between  the  code-loop  tracking 
error  and  the  velocity  aiding  error  is  modelled  directly. 
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The  GPS  receiver  Kalman  filter,  on  the  other  hand,  does  not 
model  the  INS  velocity  error.  Therefore,  this  direct 
relationship  is  not  possible.  But,  It  can  be  told  that  its 
code-loop  tracking  model  is  degraded  due  to  the  error  in 
the  INS  velocity  estimate.  One  way  to  help  the  GPS 
receiver  Kalman  filter  is  to  add  pseudonoise  to  the 
code-loop  channels.  Neglecting  time-correlatedness,  this 
is  accomplished  by  transforming  the  INS  velocity  covariance 
to  velocity  covariance  along  the  1 ine-of-sight  vectors  and 
adding  it  as  driving  noise  on  the  code-loop  dynamics. 

Thus,  is  treated,  within  the  GPS  receiver  Kalman 

filter,  as  a  white  noise  with  associated  strength 


'o  .  .  > 
aid  c 


Ur  v  .  .iiv  .  ,u  .  _ 
LOs  -aid  -aid  los 


(  3-90) 


where  is  the  noise  strenath  added  to  the  code-loop 

ala  c 

model . 

3. 7. 3. 2  Baseline  system.  The  baseline  system, 
which  contains  the  interacting  10-state  INS  Kalman  filter 
and  12-state  GPS  receiver  Kalman  filter,  is  treated 
identically  as  the  full-order  system,  conceptually. 
However,  a  major  shortcoming  exists:  the  12-state  GPS 
receiver  Kalman  filter  does  not  contain  a  model  of  the 
code-loop  dynamics.  Therefore,  in  the  context  of  the 
previous  section,  the  D  matrix  of  Equation  (3-88)  is  a 
matrix  of  zeros  and  cannot  be  incorporated  to 

w  JO  c 


benefit  the  GPS  receiver  Kalman  filter  at  all. 


3 . 8  Closing  Remarks 

Chapter  III  presents  the  fundamental  concepts  which 
lead  to  a  performance  analysis.  The  truth  model,  as  well 
as  the  joint-solution  system,  the  full-state  system,  and 
the  baseline  system  are  presented.  The  next  chapter 
applies  these  concepts  to  obtain  covariance  analysis 
results  for  a  given  system  model  and  trajectory. 


Analysis  of  the  GPS-aided  INS  sysrems,  described 
previously,  requires  a  simulated  trajectory  about  which  the 
INS  portion  of  the  truth  model  is  linearized.  Four 
trajectories  are  explored  as  possible  candidates,  and  are 
described  in  this  chapter.  The  results  of  several 
performance  analysis  simulations  are  presented.  The 
analysis  is  performed  for  static  conditions,  that  is,  the 
vehicle  is  motionless  with  respect  to  earth;  for  constant 
east  velocity;  and  for  a  constant  9g  acceleration  turn. 

The  systems  compared  Include  the  complete  (19-state)  INS 
Kalman  filter,  the  complete  (24-state)  GPS  Kalman  filter, 
the  INS  and  GPS  joint-solution  Kalman  filter,  the 
two-filter  full-state  GPS  and  full-state  INS  system,  and 
the  baseline  two-filter  system  ',10  INS  states  and  12  GPS 
receiver  states .  ) 

4 . 1  Trajectory  Candidates 

The  truth  model  and  INS  Kalman  filter  require  dynamics 

rel  lnear lzatlon  so  the  linear  system  assumptions  of  the 

estimator  equations  and  performance  analysis,  as  presented, 

are  not  violated.  Examination  of  Equations  (1-18),  (3-19), 

(3-20),  and  (3-41)  reveals  the  following  parameters  require 

*  «  »  «  •  *  •  • 

relinearization:  L,  R,  a,  L,  1,  h,  L,  1,  f  ,  f_,  and  f„.. 
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These  values  are  calculated  each  Jt  seconds  from  an  assumed 
disturbance-free  trajectory,  and  Inserted  into  the 
equations  referenced  above.  As  an  approximation,  the 
computed  elements  of  the  dynamics  matrices  are  held 
constant  until  the  next  set  of  parameters  is  available.  A 
Kalman  filter  which  is  relinearized  in  this  manner  is 
commonly  called  an  extended  Kalman  filter. 

Four  constant  acceleration  turns  are  examined.  In  all 
cases,  the  latitude  is  chosen  at  45°N  and  an  altitude,  h, 
of  20,000  feet.  Thus,  using  the  earth's  radius,  Rft,  of 
20,926,435.2  feet,  R  is  calculated  as 

R  *  R  +  h  *  20,946,435.2  ft 

v 

The  value  of  earth's  rotation  rate  is  approximately 
7.2722  X  10-5  rad/s.  The  remaining  values  are  calculated 
from  the  trajectories. 

4.1.1  Horizontal  Turn  Trajectory,  in  order  to 
maintain  a  horizontal  constant  acceleration  turn,  the 
aircraft  banks  such  that  a  vertical  lg  component  of  the 
total  acceleration  exactly  offsets  the  acceleration  due  to 
gravity  In  the  vertical  direction.  The  remaining  component 
of  acceleration  in  the  horizontal  plane  is  resolved  along 
the  north  and  east  directions.  Therefore,  the  parameters 
are  calculated  from  the  following  relationships  for  an 
initial  east  heading  turning  counter-clockwise,  as  observed 
from  above : 


86 


s  stn(a) 


v„  *  s  cos (a) 

E 

VD  “  C 

^  c  £n  c  Ah  003(00 
ae  *  £e  e  Ah  sln(0<) 

£D  =  lq  =  32.1726  ft/s2 


where  the  forward  speed  of  the  aircraft,  s,  is  chosen  to  be 
975  ft/s,  a  describes  the  angular  position  through  the 
turn,  and  is  the  magnitude  of  the  horizontal  component 
of  acceleration.  These  variables  are  shown  graphically  in 
Figure  4.1.  Sign  changes  on  the  north  velocity  and 
acceleration  equation  describe  the  variables  for  a 
clockwise  turn. 

The  velocity  and  acceleration  terms  of  Equations  (4-1) 
are  transformed  to  spherical  coordinates  by  the  following 
relationships  and  Inserted  into  the  iNS-related  dynamics 
matrix: 


L  =  Vn/R 

1  =  V_/ 1 R  cos ( L ) 1 
E 

h  =  -vD 

The  path  described  from  this  trajectory  is  circular. 


L  c  VR 

1  *  Ag/IF  cos(L)J  (4-2) 
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Figure  4. 


Horizontal  Turn  variables 


t)8 


4,1.2  Vert  leal  Turn  Trajectory.  The  vertical 
trajectory,  such  as  at  an  acrobatic  loop  maneuver,  cannot 
be  circular  If  a  constant  velocity,  constant  acceleration 
turn  is  performed.  For  an  initial  eastward  path,  the 
relationships  as  represented  in  Figure  4.2  result: 

VN  -  0 

V£  •  s  cos ( Y) 
vD  »  -s  sln(>') 

AN  C  tN  =  0 
Ag  =  fE  a  lC03(>) 

fp  =  l  cos  (  }' )  -  T1 

where 

>'  is  the  angle  between  the  acceleration  vector  and  the 
.negative  gravity  direction,  and 

T  is  the  constant  magnitude  of  acceleration  commanded 
by  the  pilot  and  exerted  on  the  aircraft.  It  includes 
the  actual  acceleration,  as  well  as  the  component  of 
gravity  along  the  acceleration  vector. 

A  vertical  turn  with  an  Initial  north  heading  results  if 
the  "E"  and  "N"  subscripts  in  Equations  (4-3)  are 
exchanged.  The  relationships  of  Equations  (4-2)  also  apply 
in  these  two  cases. 

These  trajectory  analyses  are  performed  to  explore  the 
nature  of  the  eigenvalues  of  the  INS  dynamics  matrix. 


(4-3  ) 

-  T)  g  sin(>') 
g  cos(V)  -  g 
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The  eigenvalues  of  the  INS  dynamics  matrix  are 
explored  to  examine  the  characteristics  of  the  INS  during 
the  four  maneuvers  described  in  the  previous  sections.  The 
needed  parameters  are  calculated  at  15°  increments  of  a  for 
the  horizontal  trajectories,  and  15°  increments  of  Y  for 
the  vertical  turn  trajectories.  Assuming  an  aircraft  speed 
of  975  ft/s  and  constant  9g  turn,  the  parameters  are 
calculated  at  each  point  through  the  360°  turns.  These 
values  of  velocity,  acceleration,  and  specific  force  are 
used  to  linearize  the  basic  INS  equations  listed  in 
Equations  (3-18)  through  (3-26),  and  the  eigenvalues  of  the 
system  matrix  are  determined.  The  eigenvalue 
character lstl.es  of  each  of  the  four  trajectories  are 
presented . 

As  shown  in  Figures  4.3  and  4.4,  the  eigenvalues  of 
the  horizontal  trajectories,  both  clockwise  arid 
counter-clockwise,  are  identical.  The  actual  migration 
path  the  eigenvalues  take  is  not  as  important  as  the 
general  location  of  the  eigenvalues:  a  complex  pair  of 
eigenvalues  always  remains  in  the  right-half  s-plane 
throughout  the  maneuvers.  The  eigenvalue  on  the  positive 
real  axis  is  due  to  the  vertical  channel  instability. 

The  eigenvalues  generated  from  the  vertical 
trajectories  exhibit  different  character istics .  The 
eigenvalue  plot  of  the  east  initial  heading  vertical  turn 
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Figure  4.3.  Horizontal  Counter -Clockwise 
Turn  Eigenvalues 


Figure  4.4.  Horizontal  Clockwise 
Turn  Eigenvalues 
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trajectory,  as  shown  in  Figure  4.5,  exhibits  the  eigenvalue 
due  to  the  vertical  channel  instability,  plus  a  complex 
pair  which  breaks  away  from  the  Imaginary  axis,  migrates  to 
the  real  axis,  and  returns  to  the  imaginary  axis. 

The  eigenvalues  generated  from  the  north  initial 
heading  vertical  turn  trajectory,  shewn  in  Figure  4.6, 
exhibits  only  a  predominant  vertical  channel  eigenvalue  in 
the  right-half  s-plane .  This  indicates  that  the  eastward, 
or  longitudinal,  components  of  motion  result  in  an 
additional  eigenvalue  pair  In  the  unstable  region  of  the 
s-p?ane . 

As  a  result  of  this  eigenvalue  migration  study,  only 
the  initial  east  heading  horizontal  counter-clockwise  turn 
maneuver  is  chosen  for  the  remaining  simulations.  It  is 
chosen  for  two  reasons:  it  represents  the  most  unstable 
nature  of  the  four  trajectories,  and  the  angular  position. 
Of,  of  the  vehicle  in  the  turn  is  linearly  related  to  time. 
Additional  eigenvalue  plots  tor  acceleration  levels  of  7g, 
5g,  and  3g,  are  also  generated  for  this  trajectory.  As 
seen  In  Figures  4.3,  4.7,  4.e,  and  4.9,  the  complex  pairs 
of  eigenvalues  migrate  toward  the  origin  in  these 
decreasing  acceleration  increments. 


Figure  4.7. 


Eigenvalues 


7g  Horizontal  Counter-Clockwise  Turn 


Figure  4.8.  Eigenvalues 
5g  Horizontal  Counter-Clockwise  Turn 


4 . 3  Per f ormance  Analysis  Results 

A  performance  analysis,  as  described  in  Chapter  III, 
is  conducted  for  the  stationary,  constant  east  velocity, 
and  horizontal  counter-clockwise  turn  conditions.  Five 
systems  are  evaluated  for  each  condition:  the  complete 
19-state  INS  Kalman  filter,  the  complete  24-state  GPS 
receiver  Kalman  filter,  the  36-state  joint-solution  Kalman 
filter,  the  two-filter  full-state  system,  and  the  baseline 
system  which  contains  the  10-state  INS  Kalman  filter  and 
the  12-state  GPS  receiver  Kalman  filter.  For  every  system 
and  the  short  time  period  of  calculation,  the  performance 
achieved  under  the  constant  east  velocity  condition  is 
virtually  Identical  to  the  performance  achieved  under  the 
stationary  condition.  Therefore,  Only  Constant  velocity 
data  is  presented. 

The  main  reason  for  the  constant  east  velocity 
condition  is  to  allow  the  GPS  receiver  portion  of  the 
Kalman  filter  covariance  matrix  to  reach  nearly 
steady-state  conditions  before  Initiating  the  maneuver. 
Because  of  Schuler  and  Foucault-induced  errors  present  In 
the  INS  dynamics,  no  true  steady-state  condition  exists. 
Therefore,  the  starting  time  for  the  turn  coincides  with 
the  steady-state  time  of  the  GPS  receiver  Kalman  filter. 

In  each  case,  measurement  updates  and  INS  dynamics 
rellnear lzatlon  occur  at  each  15°  interval  through  the 
turn,  starting  at  0°.  This  results  in  dtt  «= 


0.887  seconds 


For  the  two-filter  systems,  the  GPS  receiver  code  loop  is 
commanded  with  the  best  available  INS  estimate  at  four 
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times  per  measurement  Interval,  resulting  in  tk  =  0.2218 
seconds . 

Representative  values  for  the  discrete-time  process 
noises  are  chosen  to  drive  the  system  dynamics; 
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These  noises  are  also  modelled  within  each  of  the 
applicable  Kalman  filters.  The  truth  model  has  Initial 
uncertainties  in  order  to  begin  the  performance  analysis: 


4  X  10  8  rad 


1000  ft 
1  ft/sec 
707.1  ft 


=  2.648  X  10  rad/sec 
*  1.515  X  10~3  ft/sec2 


=  1  X  10 

=  3.136  X  10~2  sec 
=  3.136  X  10'4 
=  10  ft 


The  GPS  receiver  and  INS  Ka.lman  filters  are  initialized, 
for  gain  calculation  purposes,  at  the  same  values  of 
uncertainty  for  the  respective  error  states  as  the  truth 
model  states.  The  entire  covariance  matrix,  which  fills  in 
with  cross -covar lance  Information  during  the  time  for  the 


GPS  receiver  Kalman  filter  to  reach  steady-state.  Is  used 
as  initial  conditions  for  the  turn  start.  The  measurement 
noises  for  the  four  pseudorange  measurements  are  assumed  to 
be  uncorrelated  and  contribute  ±5  ft  (1(7)  error.  The  noise 
associated  with  the  vertical  position  measurement  is  chosen 
as  ±10  ft  ( Id)  . 

Unit  LOS  vectors  to  four  satellites,  representative  of 
an  actual  GPS  satellite  constellation  are  chosen  with  good 
relative  geometry  (Lewantowlcz,  1987).  Expressed  in  the 
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These  vectors  are  also  used  In  the  transformations  between 
the  LOS  errors  and  navigation  frame  errors. 

The  values  presented  in  this  section  are  common  to 
each  of  the  systems  under  test.  The  next  sections  present 
the  data  obtained  from  each  of  the  performance  analyses. 


Figure  4.11.  GPS  Receiver  velocity  Errors 
(Constant  East  Velocity) 
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4.3.1  24-State  GPS  Receiver  Kalman  Filter .  The 
complete  (24-state)  GPS  receiver  Kalman  filter  performance 
Is  demonstrated.  When  subjected  to  a  benign  environment  of 
stationary  or  constant  velocity  conditions,  the  position 
errors  (Figure  4.10)  exhibit  very  little  change  after  10 
measurement  updates.  This  rapid  convergence  Is  attributed 
to  the  high  accuracy  of  the  pseudorange  measurements.  The 
vertical  position  error  Is  lower  than  the  north  and  east 
position  errors  due  to  the  additional  measurement  from  the 
altimeter.  The  velocity  errors.  Figure  4.11,  require  45 
measurement  updates  before  reaching  essentially 
steady-state.  This  additional  time  is  expected  since  no 
velocity  measurements  are  available  In  the  modelled  GPS 
receiver  Kalman  filter.  The  1 a  steady-state  errors,  for 
the  modelled  parameters,  achieved  are 
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The  resulting  covariance  matrix  is  used  as  the  initial 
conditions,  corresponding  to  GPS  receiver  state 
uncertainties,  for  the  horizontal  turn  maneuver.  As  shown 
in  Figures  4.12  and  4.13  in  which  each  update  occurs  in  15° 
increments  about  the  turn,  the  GPS  receiver  tracks  the 
position  without  appreciable  degradation  through  three 


Figure  4.13.  GPS  Receiver  Velocity  Errors 

(9g  Turn) 
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complete  turns.  The  north  and  east  velocity  errors,  after 
an  Initial  transient,  modulates  at  the  turn  frequency, 
while  the  vertical  velocity  error  doubles  its  amplitude 
after  three  turns  are  completed. 

The  OPS  receiver  solution  did  not  go  catastrophically 
unstable  as  actual  flight  tests  demonstrate.  Two  reasons 
may  contribute  to  this  observation: 

a.  The  GPS  code  loop  is  modelled  with  a  1  Hz  bandwidth 
bandbass  filter,  while  the  frequency  of  the  turn  is 
approximately  0.3  Hz; 

b.  The  velocity  errors  are  related  to  the  code  loop 
tracking  errors,  which  is  assumed  linear  in  operation 
during  this  study.  However,  the  dynamics  of  the  code 
loop  is  very  nonlinear  outside  of  a  small  region.  The 
errors  in  the  code  loop  are  related  to  a  phase  shift. 
If  this  phase  shift  is  great  enough,  the  system  enters 
the  nonlinear  region  and  becomes  unstable. 

4.3.2  19-stat.e  INS  Kalman  Filter .  Figures  4.14 
through  4.17  exhibit  the  position  and  velocity  errors 
committed  by  the  19-state  INS  Kalman  filter  dur*.ig  the  same 
time  period  as  that  of  the  GPS  receiver  Kalman  filter 
analysis.  Since  the  INS  processes  only  altitude 
measurements,  the  north  and  east  errors  (Figures  4.14  and 
4.16)  Increase  throughout  the  short  time  period.  The  north 
position  error  is  related  to  Schuler  frequency,  while  th< 
east  error  is  Schuler  superimposed  on  a  ramp.  This  is  not 

103 


'.•AWV.VlCOAW.V  iW  O'  lO  H.’X*  KT  AAklv'.  O  V,  V  O’  ■O’  O  VOrO' V'V 


FEET  { 1  -SIGMA) 


1000.6 


Figure  i.u.  ihs  North  and  Beat  PoeUlon  Error, 
(Constant  East  Velocity) 


-1  560 


Figure  4.15.  ins  Vertical  Position  Errors 
(Constant  East  Velocity) 


readily  apparent  for  the  short  time  of  Interest.  The 
vertical  error;  (Figures  4.1b  and  4.17)  Improve  steadily 
throughout  the  turn  due  to  the  vertical  position 
measurement  from  the  altimeter.  After  45  measurement 
updates,  the  la  ins  Kalman  filter  errors  are 
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During  the  turn,  the  high  frequency  accuracy  of  the 
INS  is  demonstrated.  As  seen  in  Figures  4.18  through  4.21, 
the  north  and  east  errors  during  the  turn  primarily  follow 
the  turn-induced  frequency.  The  vertical  channel  continues 
to  receive  the  altimeter  measurement,  thus  exhibiting  no 
frequency  content  due  to  the  horizontal  raanuever . 

4.3.3  Joint-Solution  Kalman  Filter.  The  36-state 
joint-solution  Kalman  filter  follows  closely  to  the  highly 
accurate  GPS  receiver  Kalmar,  filter  solution  as  shown  in 
Figures  4.22  and  4.23  for  constant  east  velocity.  During 
the  turn  (Figures  4.24  and  4.25),  the  joint-solution  filter 
exhibits  the  benefit  of  modelling  the  INS.  After  an 
initial  overshoot,  the  errors  reduce  to  below  Initial 
uncertainty  levels.  This  is  expected  since  the 
joint-solution  Kalman  filter  appropriately  weighs  the 
accuracy  of  its  Internal  model.  The  performance  of  this 
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Figure  4,1*.  INS  Vertical  Position  Errors 
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Figure  4.22.  Joint-Solution  Position  Errors 
(Constant  East  Velocity) 


Figure  4.23.  Joint-Solution  Velocity  Errors 
(Constant  East  Velocity) 
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Figure  4.25.  Joint-Solution  Velocity  Errors 

(9g  Turn) 
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filter  represents  the  best  possible  performance  of  all  the 
systems  modelled.  However,  the  code  loop  tracking  errors 
must  be  reviewed  to  assure  linear  operation  is  maintained 
throughout  the  transient  behavior  of  the  turn. 

4.3.4  Two-Filter  Systems .  The  two-filter  system 
analysis  is  not  complete  and  no  conclusions  can  be  drawn  at 
this  time.  The  expected  instability  of  the  two-filter 
interaction  is  not  yet  observed.  In  the  covariance 
analysis  algorithm  the  INS  Kalman  filter  appears  to  be  not 
receiving  the  expected  GPS  generated  position  and  velocity 
error  measurements.  This  deficiency  is  crucial  to  the  loop 
closure  and  the  expected  instability.  This  exploration  is 
deferred  to  follow-on  research. 
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The  original  objective  of  this  study  was  to  determine 
what  minimum  additional  Information  Is  required  to  be 
passed  between  the  INS  Kalman  filter  and  the  GPS  Kalman 
filter  to  obtain  a  stable,  and  acceptably  performing, 
closed-loop  system  during  high-dynamic  maneuvers.  This 
ultimate  objective  was  not  reached  during  this  study. 
However,  several  initial  steps  are  completed  towards 
accomplishing  this  goal.  The  combined  INS/GPS 
Joint-solution  model  performance  displays  the 
characteristics  of  the  GPS  receiver  during  benign 
conditions,  and  weighs  the  INS  characteristics 
appropriately  during  the  selected  maneuver.  Work  remains 
to  be  accomplished  before  the  two-filter  system  analysis 
reaches  fruition.  From  the  significant  insight  gained  from 
this  study,  the  recommended  follow-on  effort  should 
Include : 

a.  Model  refinement  Is  necessary  such  that  more 
complex  and  realistic  flight  scenarios  are  explored. 
These  model  refinements  Include: 

i.  Actual  INS  model  parameters  for  a  specific 
system  application  is  required.  The  models  used 
in  this  study  neglected  several  error  sources 
because  the  situation  did  not  warrant  the 
additional  complexity.  However,  some  of  the 
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neglected  error  sources  contribute  significantly 
as  flight  time  progresses. 

11.  Exploration  of  the  GPS  receiver  code  loop 
model  parameters  for  adequacy  is  required. 

Models  of  the  code  loop  dynamics  are  not  readily 
available,  particularly  parameter  values.  Since 
this  model  is  essential  for  a  proper  study  to  be 
conducted,  an  accurate  description  of  the  model 
and  error  sources  is  crucial. 

ili.  in  addition  to  the  code  loop  model,  the  GPS 
model  parameters,  in  general,  need  further 
refinement.  Again,  this  additional  adjustment 
should  be  representative  of  the  actual  system. 

The  values  used  in  this  study,  for  initial 
uncertainties,  and  system  noises,  were  derived 
from  articles  written  during  the  early  phases  of 
GPS  development.  since  much  more  has  been 
accomplished  in  the  time  of  these  articles 
regarding  GPS  technology.  It  Is  likely  modelling 
philosophy  has  changed  and  should  be  reflected, 
b.  The  code  loop  errors  require  monitoring  during  the 
performance  analysis.  The  linear  region  of  these 
errors  is  modelled  In  this  study.  However,  if  the 
phase  shift  of  the  code  tracking  loop  becomes  too 
large,  then  the  linear  assumptions  are  violated,  and 
rapid  loss  of  lock  occurs.  These  errors  were  not 


observed  during  the  course  of  this  study,  because  any 
instability  was  expected  to  be  displayed  through  the 
position  and  velocity  errors.  In  retrospect,  this 
does  not  appear  to  be  true  for  linear  assumptions. 

c.  The  INS  measurement  update  portion  of  the 
two-filter  system  requires  examination.  Preliminary 
results  of  this  scenario  displayed  inadequate 
weighting  of  the  GPS-derived  measurement  wlthl’  the 
INS  Kalman  filter.  This  problem  requires  a  solution 
to  validate  the  algorithm. 

d.  GPS  satellite  geometry  requires  consideration. 

The  geometry  used  in  this  study  was  very  favorable: 
four  high  elevation  satellites.  However,  if  the 
satellites  are  near  the  horizon,  it  Is  expected  that 
larger  doppler-lnduced  shifts  of  the  code  loop  would 
occur  under  vehicle  dynamics. 

e.  The  unstable  mode  eigenvalues  of  the  INS 
linearized  dynamics  model  Indicate  that  an  extended 
period  of  hard  maneuvers  will  result  in  increased 
likelihood  of  significant  error  growth,  and  must  be 
examined . 
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Abstract 


""This  thesis  explores  the  unstable  characteristic  of  an 
Integrated  Inertial  navigation  system  (INS)  and  Global 
Positioning  System  (GPS)  receiver.  During  high-dynamic 
maneuvers,  the  ins  Kalman  filter  provides  velocity 
estimates  to  the  gps  receiver  code  loop  In  an  attempt  to 
remove  doppler-induced  tracking  errors.  The  GPS  receiver 
Kalman  filter.  In  turn,  provides  position  and  velocity 
estimates  to  correct  INS  errors.  Due  to  the  suboptimal 
nature  of  the  two  individual  filters,  this  closed-loop 
process  neglects  key  elements  of  information:  time  and 
spatial  correlation.  Therefore,  this  closed-loop  system 
quickly  becomes  unstable  during  high-dynamic  maneuvers, 
resulting  In  degraded  navigational  performance. 

Truth  models  of  the  ins  and  GPS  receiver  are 
developed.  Kalman  filters  based  on  these  two  models  are 
combined  to  yield  a  joint-solution  model  Kalman  filter 
which  serves  as  an  indication  of  the  best  structure  of 
integration  possible.  The  eigenvalues  of  the  basic  INS 
error  dynamics  model,  when  subjected  to  various  dynamic 
scenarios,  are  examined.  A  candidate  maneuver  Is  selected 
to  compare  the  performance  of  five  systems:  the  INS  truth 
model,  the  gps  receiver  truth  model,  the  joint^olutlon 
model,  a  two-filter  system  containing  the  INS  and  GPS 
receiver  truth  models,  and  a  two-filter  system  containing 
reduced-order  models  of  the  INS  and  GPS  receiver  Indicative 
of  current  system  conf  iguratton  .  {  C  — - 

The  performance  of  the  individual  Kalman  filters  and 
the  joint-solution  Kalman  filter  are  demonstrated  for  three 
selected  conditions:  stationary  with  respect  to  the  earth, 
a  constant  east  velocity,  and  a  constant  acceleration  turn 
In  the  horizontal  plane.  Results  of  the 
are  Incomplete  at  this  time,  and  require 


two-filter  systems 
follow-on  efforts. 


